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AESTBACT 


Ibis  thesis  discusses  the  modification  cr  ar.  existing 
Optimal  Systems  Control  FOR IRAN  Program  (OPTSYS)  originally 
obtained  from  Professor  Arthur  E.  Bryson  of  Stanford 
University. 

Its  aedified  FORTRAN  program  (OPTSYSX)  is  now  designed 
to  rur  completely  interactively  under  VI1/CMS  on  the  Ich  3C33 
and  is  considered  ccaplstely  compatible  with  similar  oper¬ 
ating  systeas. 

Erogram  capabilities  include:  complete  eigensystem 
analysis;  the  ability  to  perform  compurations  on  very  large 
multivariable  systems;  controller#  filter,  regulator  and 
compensator  synthesis;  transfer  function  analysis;  steady- 
state  gain  determination;  ard  modal  analysis. 

The  program  permits  users  to  rapidly  carry  out  simula¬ 
tion#  analysis#  end  design  of  all  classes  cf  Optimal  Systems 
Ccntxcl  problems  in  a  totally  interactive  mode.  Examples  of 
various  types  of  problems  are  worked  out  during  individual 
texmical  sessions. 
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SIJ5ECLS 

A  =  state  (Ns,  Ns)  or  output  (Ho,  Ha)  weighting  matrix 
B  *  control  (Nc,Nc)  weighting  matrix 
C  *  control  gair.  matrix  (Nc,Ns) 

D  s  control  (Nc,Hc)  or  ncise  (No, N g)  feedforward 
matrix 

E  *  expected  value 

F  *  cpen-lcop  djnamics  matrix  (Ns, Ns) 

G  *  control  distribution  matrix  (Ns,Nc) 

GAM  *  state  disturbance  distribution  matrix  (Ns,Ng) 
h  *  measurement  scaling  matrix  (No, Ns) 

K  »  estimator  gain  matrix  (Ns, Nob) 

Nc  *  cumber  of  controls 

Sg  *  number  of  process  ncise  sources 

Ns  *  number  of  states 

No  ■  number  of  observations  or  measurements 
£>  *  covariance  matrix  of  estimate  error  (Ns, Ns) 

C  *  white  process  noise  covariance  matrix  (Ng,sg) 

B  *  white  meas.  noise  covariance  matrix  (No, No) 

S  *  steady-state  covariance  matrix  of  control  (Nc,Nc) 
u  *  control  vector  (Nc,1) 

v  *  white  measurement  ncise  vector  (No,  1)  ,  with 
zero  mean  and  covariance  matrix  p. 
w  *  white  process  noise  vector  (Ng,1),  with 
zero  mean  and  covariance  matrix  Q 
wO  »  constant  disturbance  vector  (Ng,  1) 
x  *  state  vectci  (Ns,  1) 
x €  «  estimate  of  state  vector  (Ns,l) 
y  *  cutput/measurement  vector  (No,1) 
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I.  rSlBOEDCTIOS 

The  purpose  cr  this  thesis  is  to  describe  the  extensive 
modification  and  improvement  of  an  existing  FORTRAN  program 
(OPTS YS)  used  in  the  study,  design,  and  application  cf 
Optimal  Systems  Control  theory. 

This  optimal  systems  control  program  was  originally 
developed  ty  Hall  [Bef.  1 ]  in  1971  to  support  his  research 
in  rctary-wing  VTOL  aircraft  control  systems.  The  latest 
program  modifications  were  made  by  Walker  [Ref.  2]  and  Liu 
[Bef.  3]  cf  Stanford  University,  to  OPTSYS  a  and  CfTSYS  5 
respectively.  These  program  versions  performed  quite  satis¬ 
factorily  in  the  batch  environment,  but  exhibited  varying 
degrees  cf  user  hostility  due  to  data  input  format  require¬ 
ments  and  incomplete  program  documentation. 

The  criginal  intert  of  this  work  was  to  adapt  Walker's 
modified  version  of  CETSYS  to  run  interactively  under  VH/cms 
cn  the  IBM  3033;  however,  the  extensive  mcdif icaticns  of 
CPTSYSX  rcw  represent  a  high-level  interactive  applications 
software  system  capable  of  integrated  simulation,  analysis, 
synthesis  atd  design  of  broad  classes  of  optimal  systems 
control  problems.  Kith  OPISYSX  users  may  now  evaluate 
varices  specialized  optimal  systems  control  application, 
relieved  of  the  burden  of  lengthy  mathematical  pregram 
development . 

It  is  assumed  that  the  reader/user  is  familiar  with  the 
basic  concepts  of  Ccrtrol  Theory  and  Optimal  Systems  Design. 
The  prctlem  descriptions  and  program  development  fellow  the 
terminology  and  symbol/naming  conventions  of  Exyson 

[Bef.  4]. 

An  explanation  cf  the  basic  system  of  equations,  the 
terms  and  symbolcgy  used,  and  a  program  overview  including 
the  general  methods  cf  solution  are  presented  first. 
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Interactive  program  development  is  then  discus 
an  « xtlaraticn  cf  several  alternate  options  ava 
data  input. 


Ibis 

problems 
copy  cf 
complete 


work  concludes  with  examples  cf  various 
demonstrated  in  the  interactive  mode,  i 
each  terminal  session  with  the  final  re 
program  listing  is  included  in  Appendix  A 
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II.  THE  OPTS Y SX  COMPUTER  PROGRAM 

A.  ISTECDOCTION 

CP1SYSX  is  a  double-precision  FORTRAN  program  esplcying 
modern  control  theory  analysis  techniques.  Although  the 
program  was  originally  written  tc  syntnesize  controllers  for 
rotary-wing  VTOL  aircraft  [  Eef .  5],  it  has  been  expensively 
modified  tc  enable  controller,  filter,  and  regulator 
synthesis  as  well  as  transfer  function  and  modal  analysis  on 
ether  types  of  large,  multi-variable  systems  cf  equations. 
The  program  modifications  described  in  this  work  new  allow 
rapid  numerical  computer  analysis  in  a  completely  interac¬ 
tive  mode. 

E.  SYSTEM/ MODEL  DESCEIPTION 

CETSYSX  treats  a  linear  stationary  system  model: 

X  =  [F]x  ♦  [G]U  +  [GAMMA  ]v  (2.1) 

cutput  equation 

y  =  £H]x  ♦  [D]u  (2.2) 

measurement  equation 

2  *  £H  ]x  ♦  £D  Jw  ♦  v  (2.3) 

where 

u  *  control  vector  (m  X  1) 
v  »  white  measurement  ncise  vector  (p  X  1) 
t  =  white  process  noise  vector  (q  X  1) 
x  3  state  vector  (n  X  1) 

1 1 


y  =  output  vector  (p  X  1) 

2  =  measurement  vector  <p  X  1) 


w*  V  ~  ^  1  ***  /*«  *~«  ?  «i  w  i  f  «  c;  m 


i  ~c  i  v.  (s1* 


Plant  matrix);  [Gj  is  the  control  distribution  matrix; 
£GAMHA]  is  the  process  noise  distribution  matrix;  £H]  is  the 
iieasuiement  distribution  matrix;  and  and  [D]  may  represent  a 
feed-forwarc  distribution  matrix  cf  either  the  process  noise 
vector  (w)  ,  or  the  control  vector  (u)  . 

The  w  vector  has  zero  mean  value,  and  a  covariance 
natrix  £C]»  where: 


E  (w)  =0 


(2.4) 


£C]  ■  E[vvt: 


(2.5) 


Tie  v  vector  has  zero  mean  value  and  a  covariance  matrix 
£R],  where: 


E(v)  =  0 


(2.6) 


m  =  ecvvt: 


(2.7) 


The  cuadratic  performance  (or  cost)  index  for  the  linear 
guadradic  regulator  is  the  expected  value  cf: 


J  =  1/2^{yT  £  A  ]y  ♦  uT[  B  ]u}  dt 


(2.8) 


in  the  statistical  steady- state,  where  [A]  represents  an 
output  ccst  matrix  (a  weighting  on  the  output  variables); 
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If  fell  state  weighting  is  desired,  i  a  ]  as  :;:r 
ty  the  identity  matrix  [I]. 


i 

C.  EBCGE AM  OUTPUT 

1 •  Ccen-Loo  c  Ricensvst  em  Caicula  taens 


enteu 


Ihe  initial  portion  of  CPTSISX  output  includes  the 
program  flew  control  flags  set  by  the  user  for  that  partre- 
ular  run,  the  system  of  equations  being  modeled,  and  the 
open-loop  eigenvalue  and  eigenvector  calculations  of  the  £?] 
matrix. 


2.  Regulator  Synthesis  Calculations 


full 


In 

state 


the  solution  to  the  optimal  regulator 
variable  feedback  is  assumed  where: 


problem. 


[C]  =  [B-‘]£Gt]£S] 


(2.9) 


and 


u  =  -£  C]x  (2.  10) 

The  control  cain  £C]  is  a  matrix  of  optimal  gains 
which  minimize  the  cost  index  expressed  in  equation  (2.8). 

Ecr  optimal  regulator  synthesis  problems,  program 
output  includes  the  closed-loop  eigenvalues  and  eigenvec¬ 
tors;  the  control  gain  £C];  the  closed-loop  dynamics  matrix 
£F-GC];  anc  the  steady-state  gain  matrix  £S],  where  [S]  is 
the  steady-state  solction  to  the  algebraic  Riccati  equation: 

S[f;  ♦  £FT]S  -  S£G][E-']£GT]S  ♦  [HT]£A]£H]  =  0  (2.11) 
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UllSS.  Synthesis 


j . 


Ca  lculatlo;.s 


A  Falx an  filter  cr  Estimator  which  descric*r 
continuers  time  systei  may  he  written  as: 


x  *  [  F  ]x  ♦  [  K  ]  (z  -  [  h  ]x) 


(2.12) 


where  : 

A 

x  is  the  state  estimate 
[K]  is  a  ae.rix  of  filter  gains, 
and  the  state  covariarce  is  described  by: 

E  (xxr)  *  E  (xxT)  ♦  [F  :  (2.  13) 


the  filter  cain  matrix  [K]  of  equation  (2.12)  is 
obtained  frcm  the  relationship: 

£  *]  *  CP  3C  Hr It  E“]  (2.  14) 

where  [E]  is  the  steady-state  solution  to  the  algetraic 
Biccati  equation; 

CO  ♦  P£FT]  -  P[ET]£fi'‘]£H]E  ♦  [G][Q][GT]  =  0  (2.15) 

representing  the  errcz  covariance  of  the  estimate  x.  The 
ccntrcl  ccvariance  is  the  expected  value  described  by: 


e  <uuT)  »  £c;xj;cT3 


(2. 16) 


For  the  Kalian  filter/optimal  estimator 
problem,  CFTS7SX  output  includes  the  eigenvalues 
vectors  of  the  optimal  estimator  (Kalman  filter)  ; 
gains  C  K  I S  error  covariance  matrix  £P];  the 


synthesis 
and  eigen- 
the  filter 
covariance 


1U 


■i 


w.iera 


satrix  cf  its  ssrisare  f  x  j; 
described  ir.  equation  (2.13), 


ccva  nar.ce 


ix  £2] 


£  X  ]  =  E£  xx 


T  . 


(2.  17) 


and  the  ccntrol  covariance  matrix  [ 'J  ]  described  in  equation 
<2.16)  . 

4.  Stationary  Cicsed-L ccr  Calculations 

The  stationary  response  of  both  state  and  centre! 
are  presented  as  roct-mean-square  values  of  the  state  and 
control  covarianca  jratricas[X]  and  £U]  described  in  equa¬ 
tions  (2.17)  and  (2.16)  respectively. 


E.  SCI01ICH  &LGCRITEE 

Cne  cf  the  fundamental  techniques  necessary  to  quadratic 
synthesis  cf  optimal  control  systems  is  the  steady-state 
solution  of  the  alqetraic  Hiccati  equation.  This  is  a  non¬ 
trivial  task  due  to  the  iterative  nature  of  the  solution. 

The  steady-state  solution  by  any  quadrature  method 
necessitates  time  increment  selection  no  qreater  than  seme 
fraction  cf  the  shortest  period  of  the  closed-loop  system; 
imposing  a  significant  computer  solution  time  expenditure  on 
the  user  as  veil  as  the  requiring  an  extensive  amount  of 
computer  storage  capability  due  to  the  matrix  expansion 
factor  involved.  Further,  the  possible  necessity  cf  a 
time-varying  solution  of  these  equations  for  optimal  open 
loop  ccrtrcl  or  estimation  requires  the  inversion  cf  an 
n  X  n  matrix  for  each  time  increment  where  an  unsteady  solu¬ 
tion  is  desired. 

A  powerful  and  efficient  alternate  method  cf  solution 
was  developed  by  Bryscn  and  Hall  £Bef.  7],  based  cn  eigen¬ 
vector  deccmpositior  of  the  sigensystem  of  the  constant 
coefficient  EULEB-L agbange  eguations. 
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let  the  optimal  regulator,  these  equations  take  th- 
ferm : 


Fcr  the  optiaal  filter  or  estimator,  the  equations  are 
cf  rfce  for®: 


CTISJSX,  and  all  earlier  program  versions,  use  the 
aethed  cf  eigenvector  decomposition  of  the  EaL£S-LACFA»GE 
equations  described  in  [Ref.  7]  for  quadratic  synthesis  cf 
contrcl  systems.  Program  calculations  are  based  cn  the  QR 
algcritha  cf  Francis,  modified  by  Wilkinson  [Bef.  8]. 
Important  features  cf  this  aethed  of  eigensystem  analysis 
are  its  improved  accuracy,  and  its  insensitivity  tc  widely 
separatee  eigenvalues. 

A  mere  detailed  description  of  the  QR  algorithm  and  its 
numerical  applications  to  eigensystem  analysis  may  be  found 

in  [ Bef.  8 ] . 

E.  EEOGfAH  OVERVIEW 

CETSISX  and  its  bl  subroutines  may  be  divided  into 
three  basic  categories: 

1)  setup  ard  computation  sequencing 

2)  data  input 

3)  calculation 

A  brief  and  general  description  of  the  program  modules 
and  subroutines  supporting  these  basic  categories  concludes 
this  section. 
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1.  Problem  Eescziption/Pgcgram  £^22  Ccr.trol 


lie  MAIN  program  allows  interactive  selsct 
program  flew  control  flags,  and  is  ailed  by  t nr 
tines  :  REPEAL,  RDINI,  and  EDCHAR.  A  detailed  d 
cf  these  subroutines  is  provided  in  Chapter  III. 
CHECK  verifies  the  consistency  of  all  requests 


surrcu- 
escripticn 
3 u trout ins 
d  program 


cpticrs. 


2.  Interact  ^ve  Eata  In  put 


Interactive  cata  input  is  performed  by  the  Id  3£AE _ 

subroutines.  A  detailed  description  cf  the  operation  of 
these  subroutines  is  also  included  in  Chapter  III.  Internal 
data  generation  or  external  data  input  is  provided  by 
subroutine  SETUP . 


3-  Calculation  Sequencing 

Subroutine  ISKEH  functions  as  a  second  MAIN  program. 
It  orders  tie  data  irput/ca lculation  sequences  for  the  type 
cf  prctleir  being  solved  and  performs  numerous  matrix  calcu¬ 
lations.  It  is  from  this  subroutine  that  all  input  and 
calculation  sequences  are  ordered  and  performed. 

d .  £R  Algorithm  Iransf craaticn 

Subroutines  MINV,  BALANC,  OSTHES ,  ORTBAN,  HCE,  HQE2 , 
EALBAK,  CNCBM,  and  EREXIT  perform  the  major  calculation 
sequences  cf  the  "Qfi"  algorithm. 

5«  Riccati  Equation  Calculations 

Subroutine  PGAIN  separates  the  eigenvalues  and 
eigenvectors  of  the  Euler-L agrange  equations  by  eigenvector 
decomposition.  RG AIN  and  subroutine  SCOV  calculate  the 
steady-state  soluticn  cf  tie  Riccati  equations  for  the 
ccntrcller  cr  estimator  problem.  Subroutine  SCOV  computes 


the  covariance  matrix  solution  to  the  algebraic  Hie:"! 
equation. 

6 .  go $ si  Calculations 

Subroutine  MCEE  confutes  the  modal  transformations 
required  for  modal  analysis. 

7 .  Iransf er  Function  Calculations 

Subroutines  U,  POLES,  ZEEOS,  RESID,  kCOllP,  CCOI1P, 
E£R,  and  Function  SCI  perform  transfer  function  computations 
associated  with  Modal  calculation  sequences.  Subroutine 
PSDCA1  ccmputes  the  fewer  spectral  density  of  the  outputs  or 
ccntrcls  cf  a  controlled  system. 

8  -  Eat  a  Output 

Subroutine  B 4PRNT  prints  all  program  calculations  in 
object  time  format.  Subroutine  MATPET  allows  variable 
format  serein  viewing  of  all  interactive  matrix  data  input. 
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1.  Ef  SIGN  COS  SI  CEB  A  HOBS 


Curing  the  development  cf  CPTSYSX,  all  program  modifica¬ 
tions  and  additions  were  recused  primarily  toward 
tave  user  operation.  Experience  has  demonstrated  that 
interactive  computer  communication  offers  many  advantages  in 
the  research  and  problem  solving  environment.  The  opportu¬ 
nity  for  flexible  and  immediate  computer  communication,  as 
sell  as  the  ability  to  select  alternate  solution  methods, 
are  significant  advartages  to  the  user;  advantages  which  are 
unavailable  in  a  batch  processing  environment. 

Although  previous  versions  of  OPTSYS  produced  ail  the 
desired  calculations  in  the  hatch  environment,  the  input 
.format  and  data  sequencing  and  naming  conventions  were 
confusing  tc  many  users.  The  user  was  burdened  with  the 
necessity  cf  verifying  the  correctness  of  input  data  fcriat 
and  program  flow  control  flag  settings  for  each  program  run, 
in  cider  tc  ensure  the  desired  calculation  sequence  was 
properly  performed. 

These  requirements,  combined  with  incomplete  program 
documentation,  promoted  a  lack  cf  confidence  in  the  results 
and  discouraged  many  potential  users  from  ever,  attempting  to 
use  CETSYS. 

E.  EECGEAE  LANGUAGE 

CETSYSX  is  programmed  in  FORTRAN  IV,  following  the 
conventions  of  I  EM  System/360/370  FORTRAN  IV  language.  Very 
few  program  features  have  teen  been  incorporated  which  are 
ret  Knitter  in  ANSI  Standard  FORTRAN.  These  subtle  differ¬ 
ences  notwithstanding,  OP1SYSX  has  been  compiled  and  run 


under  iccth  FORTRAN  IV  ( G 1 )  and  FORTRAN  H  (Extended* 
ccapilerc  cn  the  IBi  3033.  Although  toe  overall 
length  is  it  excess  cf  2600  lores  of  text,  it  is  cc.sic -  red 
completely  portable  from  one  operating  system  to  another. 

Cr  the  presumption  that  most  scientific  and  research 
personnel  are  familiar  with  FORTRAN  language,  program  modi¬ 
fications  may  be  easily  undertaker,  once  system  operation  is 
under st red. 

C.  GISEBAI  PROGRAM  ECCIFIC  ATICNS 

All  cf  the  previously  developed  numerical  calculation 
sequences  cf  OPTSYS  were  retained  un-modified  in  OPTSYSX. 

These  program  seguences  requiring  the  input  cf  diagonal 
cost  cr  covariance  matrix  elements  were  deleted  or  modified 
to  improve  user  flexibility  in  entering  any  desired 
weighting  matrix,  diagonal  or  otherwise.  This  modification 
streamlined  program  operation  through  elimination  cf  several 
progxai  flew  control  flags;  reduced  a  measure  of  user  uncer¬ 
tainty;  anc  further  decreased  the  required  degree  cf  user 
program  familiarity-promoting  uninterrupted  operation. 

The  EEJE  subroutines  represent  variations  or.  the  prin¬ 
ciple  cf  simple,  affective  methods  of  interactive  input, 
coupled  with  errcr-ccrrecti cn/recover y  sequences. 

Sutrcutines  RDCHAE,  RDINT,  and  BOREAL  were  developed  by 
the  author  and  Cdr.  P.D.  Sullivan  to  accomodate  varying 
input  format  requirements;  null-string  entry  protection  was 
developed  by  cdr.  P.E.  Sullivan.  These  program  features  are 
discussed  in  greater  detail  later  in  this  chapter. 


L.  INTERACTIVE  EROGEAB  DEV  ELCEHENT 

1  •  Rrccras  Flew  Centro  1 

Initial  program  development  reguired  an  ur.d  -r- 
s-ar.dinc  cf  the  various  problem  descriptions  as  well  as 
program  input  and  calculation  seguance.  After  careful  anal¬ 
ysis  cf  [Bef.  2],  a  basic  program  flow  control  diagram  was 
established.  From  this  flew  control  diagram,  a  logical 
branching  network  was  formulated  whose  path  could  he  deter¬ 
mined  through  either  binary  logic  or  numerical  selection. 

Three  basic  branching  categories  were  established 
from  the  various  problem  description  statements: 

Logical - {’’Yes"  cr  "No"..} 

Integer - ("  1*,  »2»,  etc. . .} 

Real  Number - {"Input  the  value  of...} 

from  the  viewpoint  cf  free-format  computer  ccmnuni- 
caticr,  integer  and  real  number  input  presented  no  signifi¬ 
cant  problems.  FOEIRAN  compiler  language  is  written  such 
that  numerical  data  input  (real  number  or  integer)  is 
expected,  thereby  ieguiritg  only  an  INTEGER  or  ■  REAL  data 
type  statement  within  the  program.  Once  the  data  type  has 
teen  declared,  the  desired  values  may  then  be  input  with  a 
free-fcrmat  READ  (5,*)  statement. 

Cne  note  of  caution  concerning  numerical  data  input 
in  free-format  deserves  mentioning;  Although  all  FCFTKAN 
compilers  treat  character  string  input  as  an  illegal  data 
type  conversion,  many  will  automatically  convert  the  inad¬ 
vertent  character  entry  to  a  "zero"  and  continue  execution. 
Erotecticn  against  inadvertent  errors  cf  this  type  is 
discussed  later  in  this  chapter. 

logical  input  ("Yes"  cr  "No")  poses  a  unigue  problem 
to  programmers.  The  usual  method  of  incorporation  is  to 
reguire  the  user  tc  convert  the  logical  answer  into  an 
integer  i.e.,  "Yes"  *  1,  "No"  *  2.  These  integers  may  then 
be  read  cirectly  into  the  program,  determining  program  flew. 


Although  this  methcd  may  promote  programming  enss, 
it  requires  the  user  tc  adopt  a'  unnatural. 
pattern — cae  vhica  increases  the  possibility  of  arncr-al 
program  ttiminaoicz  in  tin  cvrnt  of  irad v rrtart  -rror. 

A  mere  refired  (from  a  programming  language  stand¬ 
point)  and  ergonomic  (from  the  user  viewpoint)  method  of 
logical  selection  involves  utilization  of  the  entire  char¬ 
acter  string  answer  as  an  input  value.  This  method  has  beer, 
incorporated  into  OP1SYSX. 

Tie  logical  strings  ("Yes"  and  "No)  are  declared  as 
character  strings  in  a  data  type  statement  within  the 
program  cr  subprogram.  A  fermat  statement  is  also  included 
in  the  pregram  or  subprogram  utilizing  the  "A"-field  to 
specify  tie  desired  character  field  width.  A  REMIND  state- 
sent  is  tier  incorporated  in  the  specific  program  cr  subpro¬ 
gram  immediately  prior  to  each  logical  string  input  point. 
This  REMIND  statement  allows  the  input  device  (the  terminal 
screen  in  this  case)  to  read  the  character  string  in  the 
same  iranrer  as  free-fermat  data  input.  The  character  field 
width  fer  this  modification  was  established  at  A1,  allowing 
streamlined  operaticr  with  the  user  typing  either  "Y"  or 
"Yes"  for  an  affirmative  reply;  "N"  or  "No"  for  a  negative 
reply . 


General  Input  Segue  pcing  Requirements 


All  data  input  to  0ET5YSX  is  in  matrix  or  vector 
format.  This  data  input  must  be  correlated  in  accordance 
with  the  prcblem  description  and  then  properly  sequenced  in 
order  fer  fie  program  tc  perform  the  desired  calculations. 

The  original  and  modified  OPTSIS  programs  [Ref.  2] 
and  [Ref.  3]  required  not  only  problem  description  knowledge 
tut  ccmplete  user  familiarity  with  the  detailed  calculation 
seguerce  cf  the  program.  The  latter  point  was  considered  a 
significant  disadvantage.  Elimination  of  this  disadvantage 


was  sr.  area  where  interactive  programming  offer-i  -h  -- 

g.eatest  csrifrts  tc  the  potential  user;  aas  it 

this  erd  that  the  re  saining  mcdif  icaticns  of  GPTS’iiK  -=z; 

directed. 

3 .  Interact ive  £ata  Input 

In  its  calculation  sequences,  OPTSYSX  requires  the 
input  cf  up  tc  14  unique  catrices  cr  vectors.  C/.ov  the 

previcusly  described  program  flow  control  diagram  was 
constructed,  data  entry  points  for  each  matrix  cr  vector 
were  established.  At  each  cf  the  16  program  data  entry 
points,  the  required  input  matrix  or  vector  was  determined. 
Fourteen  input  subroutines  were  added  to  the  original 
program  in  order  to  accomodate  interactive  data  entry. 

These  matrix  input  subroutines  were  written  such 
that  the  user  is  first  informed  which  specific  matrix  or 
vector  is  required;  then  prompted  for  the  individual  matrix 
element  values.  These  values  are  then  individually  and 
sequentially  entered  from  the  terminal.  Once  the  matrix  or 
vector  is  filled,  it  is  returned  to  the  terminal  screen  for 
user  verification  and  correcticn  if  necessary. 

Interactive  sequential  data  entry  was  programmed  by 
means  cf  a  two-dimensional  EC  loop,  with  a  terminal  prompt 
cf  the  matrix  name  arc  element  position  prior  to  the  element 
value  entry.  Data  element  input  is  via  a  free-format  READ 
(5,*)  pregram  statement. 

Cnee  the  matrix  data  entry  sequence  is  complete, 
that  input  matrix  is  returned  to  the  terminal  screen  in 
variable  fermat  for  user  ease  in  row  identification.  with 
an  arbitrary  data  field  width  cf  12  characters,  the  maximum 
number  of  matrix  elements  available  on  an  SO  column  terminal 
screen  is  six.  Provided  the  matrix  column  dimension  is  less 
than  six,  this  restriction  presented  no  programming  fermat 
limitations. 
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Per  those  matrices  whese  column  dimension  exceeded 
six,  elements  were  progressively  written  ci.  z  il~  :-r.- 
tarainal  liras,  ones  the  matrix  row  is  filled  the  scr  i  r 
ccufcle-spaced,  and  element  display  is  repeated  _n  the  sate 
fashicn.  This  netted  allows  the  user  tc  view  the  rarrix 
much  as  he  would  expect  to  see  it,  providing  tie  advantage 
cf  ease  in  row  ard  column  identification. 

fcithin  CFTSXSX,  subroutine  L1ATP3T  performs  this 
variatle-f cimat  print  sequence.  The  print  sequence  was 
arbitrarily  terminated  with  a  matrix  size  of  16  x  16, 
presuming  that  users  with  larger  systems  of  equations  '.cull 
select  alternate  forms  of  data  input. 

4 .  Sa vine  Interactive  Incut 

In  most  ccnticl  system  design  problems,  the  system 
matrices  generally  remain  relatively  unchanged  for  a  desired 
sequence  cf  design  calculations. 

In  order  tc  relieve  the  us  or  of  the  burden  of 
repeated  system  entry  in  the  interactive  mode,  several  addi¬ 
tional  program  flow  control  flags  were  added,  allowing  the 
eptien  cf  saving  the  entire  original  system  of  matrices  for 
subsequent  calculations.  Separate  options  for  saving  each 
system  matrix  are  attcmatically  offered  at  the  end  of  each 
program  run. 

These  matrix  saving  options  provide  a  further  advan¬ 
tage  to  the  user  in  that  the  matrices  are  redisplayed  for 
verification  prior  tc  calculation  execution.  Users  may  then 
change  individual  matrix  elements,  relieved  of  the  burden  of 
full  system  re-entry. 

5.  Cser-Def  iaed  ipput  Filjs 

Although  the  tasic  objective  of  this  work  is  to 
provide  the  user  with  a  totally  interactive  method  cf  data 
input,  several  disadvantages  tc  the  method  of  individual 
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matrix  element  input  are  apparent — input  cf  very 
matrices  is  unwieldy  and  time-consuming;  input  cf  system  cf 
matrices  whose  elements  remain  unchanged  fret  run  :c  run  is 
inefficient . 

Jr.  order  tc  prevrde  an  increased  measure  cf  user 
fiexitility  in  data  input,  subroutine  SETUP  was  modified  to 
include  previsions  for  matrix  data  input  from  a  data  file  cn 
the  user's  disk.  The  three  system  matrices,  [F3,[G],  and 
[GAMMA]  may  now  be  input  from  the  user's  disk.  hi nor 
program  modification  is  required  of  the  user  as  follows: 

a.  FRICMS  Eiledaf  commands  must  be  modified  cr 
added  tc  reflect  the  name  and  location  cf 
each  data  set. 

t.  The  REAL  Format  statement  (or  statements)  mist 
be  changed  to  reflect  the  proper  data  format 
of  the  user's  input  file. 

6  •  Internal  Data  Generation 

As  a  further  measure  cf  flexibility,  the  documenta¬ 
tion  within  subroutine  5ETUF  was  expanded  to  include  several 
specific  examples  of  internal  matrix  data  generation.  The 
three  system  matrices  [F],  [G],  and  [GAMMA]  may  generated 

either  within  user-written  twc-diaensicnal  DO-locps  or  by 
direct  assignment  statements.  These  methods  may  be  prefer¬ 
able  for  the  input  of  very  large  matrices  with  few  nen-zero 
elements. 

A  specific  example  cf  internal  program  generation  of 
the  output  equation  [H]  matrix  is  included  in  subroutine 
EEADE.  This  matrix  input  method  may  be  preferable  for  the 
entry  cf  a  large  output  equation  matrix  with  very  few  non¬ 
zero  elements. 

Cnee  these  modifications  have  been  made  to  subrou¬ 
tine  SET  CP  or  subroutine  READE  (as  desired)  ,  the  program 
should  t«  re-compilec  and  then  run  in  the  usual  manner.  An 


r 

i 

interactive  program  prompt  is  provided  at  the  beginning  of 
CPIS YSX  offering  the  user  the  option  of  specif /_:.g 
desired  lethod  of  data  input. 


to  input  the  [H]  matrix  (or  ether  required  input  aatric.-sj 
from  separate  data  files.  Users  wita  rudimentary  program¬ 
ming  skills  may  new  modify  subroutine  REACH  (cr  one  or  the 
ether  specific  READ  subroutines)  in  the  manner  previously 
dascritsd  for  subroutine  SETUP  or  subroutine  REACH. 
Detailed  examples  of  the  nature  and  extent  of  thase  mediri- 
caticrs  may  ba  found  in  Appendix  A. 

7 .  Data  Entry  Correction 

In  an  effort  to  protect  users  from  errors  in  data 
input,  an  error  correction  sequence  was  incorporated  into 
each  matrix  input  subroutine. 

Cnee  the  entire  matrix  cr  vector  is  displayed  cn  the 
terairal  screen  the  user  is  prompted  with  the  question,  "Dc 
you  wish  to  change  tie  v£lue  of  any  matrix  element?  Type 
'Yes'  cr  'Nc'."  If  the  user  types  "No”,  program  execution 
centimes . 

If  the  user  types  "Yes",  he  is  then  prompted  with 
three  additional  statements  specifying  tae  row  number  of  the 
eleaert  tc  te  changed,  the  column  number  of  the  element  to 
be  chanced,  and  the  value  to  be  inserted  into  that  matrix 
element.  After  the  corrected  value  is  entered,  the  new 
matrix  values  are  returned  to  the  screen  for 
re-verification. 

This  correction  sequence  continues  indefinitely 
until  tie  user  signifies  that  no  additional  changes  are 
recessary.  Program  execution  then  proceeds  normally. 


E.  OSEB-EBBCH  PEOTECHON  F  E1T0BES 

Many  interactive  computer  oiograii  suffer  ti;  i:;.-;ind 
characteristic  cf  abnormal  program  termination  h'i-.heu- 
recovery!)  should  the  user  inadvertently  wake  an  error. ecus 
keyboard  entry.  Examples  cf  these  inadvertent  errors 
includs--entry  of  a  keyboard  character  cr  character  string 
when  the  picgrat  expects  a  numerical  value;  entry  cf  a 
numerical  value  wher  the  prograir  is  exp-cting  a  character 
string;  entry  cf  a  null  string.  In  order  to  preclude 
ahnorcai  program  terninatron  due  to  these  types  of  inadver¬ 
tent  user  errors,  several  program  protection  features  were 
incorporated  into  OP1SYSX. 

1 .  Cat  a  Tjpe  Conversion  Errors 

'Ihree  subroutines —  EDBEAL,  EDINT,  SDCHAB — were  added 
to  GETSYSX  in  order  to  ensure  that  the  proper  input  data 
type  is  provided  tc  the  program.  Subroutine  BD5IAI  is 
called  at  ar.y  point  a  real  nuirber  cr  zero  integer  input  ray 
be  erccurtered;  subroutine  EEINT  is  called  at  any  pcint  a 
non-zerc  integer  input  is  required;  subroutine  EECHAB  is 
called  at  any  point  a  character  string  ("Yes"  or  "No")  input 
is  required. 

Sithin  each  cf  these  subroutines  a  null  string  entry 
protection  loop  was  incorporated  (allowing  one  recovery)  ; 
prompting  the  user  fer  the  correct  data  type  input,  and 
returning  an  error  message  in  the  event  an  incorrect  data 
type  is  encountered. 

Sithin  subroutine  EDINT,  improper  data  type  entry 
was  further  protected  by  the  addition  of  a  three-way  IF 
ccopariscn  cf  entry  integer  magnitude.  This  modification 
precludes  illegal  (but  automatic,  with  some  compilers)  data 
type  conversion  errors. 
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These  program  design  features  boast  the  additional 
advantage  ci  allowing  normal  program  termination  at  ar.y 
point  in  the  data  input  phase  by  merely  pressing  the  u E -*tr" 
ksy  tkics. 

2 •  Inconsistent  Erogr a 5  Control  Fla^  Errors 

Earlier  versions  of  OETSYS  [Ref.  2]  and  [Ref.  3], 
did  provide  user  error  messages  in  the  event  cf  inconsistent 
program  flew  control  flags,  but  terminated  the  program. 
This  feature  was  undesirable  from  the  standpoint  cf  smooth 
interactive  program  operation,  and  was  improved  in  OETSYSX. 

Subroutine  CEECK  was  modified  tc  include  RETURN 
statements  any  time  inconsistent  program  flow  control  flags 
are  encountered.  The  user  is  notified  cf  the  type  or  error 
encountered;  that  run  termiration  has  occurred;  and  prompted 
regarding  his  desire  to  return  to  the  beginning  of  the 
program  or  terminate  execution  completely. 
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IV.  EBCGBAM  OS  £  AND  EXAMPLES 


This  chapter  contains  Several  basic  examples  c:  hha 
numerous  types  of  problems  which  may  be  solved  using 
CPTSYSX.  Included  with  these  examples  are  copies  cf  each 
recorded  terminal  session. 

Ectential  users  should  examine  carefully  the  example  of 
program  failure  found  in  Section  D.  This  example  clearly 
demonstrates  that  uistatle  modes  or  incorrect  choice  of 
certain  design  parameters  may  cause  program  failure  (and 
incorrect  output!) ,  even  with  the  highly  stable  "QS"  algo¬ 
rithm.  It  also  indicates  one  possible  method  of  correcting 
this  type  cf  failure  by  merely  making  a  very  small  change  to 
cne  cf  tie  design  parameters. 

A.  CEEN-1CCP  EIGEHS ISTES  ANALYSIS 

The  following  cpen-loop  eigenvalue  example  was  taken 

from  [fief.  S,  p.669  ]. 

Examination  of  tie  following  program  output  shews  epen- 
lccp  eigenvalues  at  -1,  -2,  and  -3.  Note  that  the  eigenvec¬ 
tors  cf  the  left  and  right  eigenvector  matrices  (pa.  33) 
correspctd  in  column  fashion  tc  the  open-lcop  eigenvalues 
calculated  immediately  above  them  (pa.  32) . 

The  full  terminal  session  is  recorded  below,  with  user 
input  in  lc wer  case  letters  following  each  M?w  . 

record  cn 

BEGIN  EECCREING  CF  TEEHINAL  SESSION 

E;  T*0.0  1/0 .02  21:49:20 

filedef  C6  term  (reefm  fa  blksize  133 

global  txtlib  fortmoc2  mod2eeh  imsldp  ncnimsl 

load  cptsysx  (start 
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EXECCTICK  EEGINS... 

CPTSYSX  IS  A  COMPLETELY  [N'T  ERACTI V2  OPTIMAL  SYSTEMS  CwNIRi. 
PROGRAM.  IT  Sit  I  SCIYS  MJMEECUS  CONTROL  PBCEL  Z  '/.£  C'J  TH 
FCLLCNING  TYPES  Cl  SYSTEMS  CONTROL  EQUATIONS: 

XDOT  =  (F)*X  ♦  (G)*U  ♦  (GAM)  *  (W+WO ) 

MEASUREMENT  EQUATION— 

Z  =  (K)*X  ♦  (D) *V 

REGULATOR  PERFQ  BMANCE  INDEX  — 

0  =  1/2*  INTEGRAL  (Yt*(A)*Y  *  Ut*  (B)  *U)  DT 
STATE  FEEEEACK  GAIN  DEFINITION  — 
c  =  - (C) *x 

EC  YCU  WISH  TC  CONTINUE?  TYPE  "YES"  OB  "NO". 

yes 

—  LATA  ENTRY  — 

AIlfiCCGH  OPISYSX  IS  SPECIFICALLY  DESIGNEE  TO  BEAD 
AIL  MATRIX  EAT  A  INTERACTIVELY,  SEVERAL  ALTERNATE 
METHODS  ABE  AVAIIABIE  TC  USERS: 

METHOD  1— THE  "F","G",  AND  "GAMMA"  MATRICES 

MAY  BE  READ  FBCM  SEPARATE  DATA  FILES. 

METECE  2— THE  "F","G",  AND  "GAMMA"  MATRICES  MAY  EE 

EXPLICIIIY  DEFINED  WITHIN  SUBROUTINE  "SETUP" 
(NCTE:  IN  EITHER  CASE,  THE  USER  SHOULD  OBTAIN  A  CCPY 
OF  THE  EFCGRAM  LISTING  AND  EXAMINE 
THE  EXAMPLES  CONTAINED  IN  S/R  "SETUP".) 

DO  YOG  WISH  TO  CONTINUE?  TYPE  "YES"  CB  "NO". 

yes 

EO  5CC  WISH  TO  INEUT  THE  "F",  »G",  ANE  "GAMMA" 
MATRICES  FFCM  SUBROUTINE  "SETUP"  IA W  THE 
METHOD  DESCRIBED  CN  THE  PREVIOUS  SCREEN? 

TYPE  "YES"  OR  "NO". 

EC 

GENERAL  OPISYSX  OPTIONS: 

OPTION  1  —  SYSTEM  ANAIYSIS  WITHOUT 

CEEN-LO  CP  EIGEN  SYSTEM  CALCULATIONS. 
OPTION  2  —  SYSTEM  ANAIYSIS  WITH  OPEN-LOO? 
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E1GENSY STEM  CALCULATIONS. 

Cf I  ION  3  --  CiEN-LOCF  EIGENSYSTEM  FOUND 
AND  PROGRAM  TERMINATES . 

("F'WATRIX  c&l  c‘£  FOLLOWS  I MM EDI AT  EL  i. .  ■, 
CFTICN  4  —  MCEAL  D ISTB  23UTION  MATRICES  COMPUTED 
fcITHCUT  FILTER  OB  REGULATOR  SYNTHESIS 
CB  STEADY-STATE  ANALYSIS. 

SELECT  AN  OPTICS:  1,2,3,  OR  4. 

1 

2 

ENTFE  THE  #  OF  STATES  (NS)  OF  THE  SYSTEM  MATRIX 
"F "-MATRIX  . 


f LAG/EAEAMETER  SETTINGS  FOR  THIS  RUN  ARE  AS  FCIICWS: 


IOL 

IC  IR  ISS 

IE 

IIF  1 

IT  F2 

ITF3 

IFDFW 

IE 

IEEEUG 

2 

0  0  0 

c 

0 

0 

0 

0 

0 

0 

ISET 

ICSTAE  IPSD 

I  YU 

INCEM 

IBEG 

NS 

NC 

NOB 

NG 

0 

0  0 

c 

0 

0 

3 

0 

0 

0 

ORDER  CF  SYST.EM  =  3 

NUHEEB  CF  CONTROLS  =  0 

NUMBER  CF  OBSERVATIONS  =  0 

NUHEEB  CF  EROCESS  NCISE  SOURCES  =  0 

ENTER  THE  SYSTEM  MATRIX  ,,FH-MATRIX 

DIMENSION  =  #  STATES  (NS)  X  #  STATES  (NS) 
TEE  ELEMENT  F(  1,  1)* 
x 
0 

THE  ELEMENT  F  (  1,  2)  = 

? 

1 

TEE  ELEMENT  F(  1,  3)* 


7 

0 
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THE  ELEMENT  F  (  2,  1)= 


C 

TEE  ELEMENT  F(  2,  2)  = 

7 

C 

!IB £  ELEMENT  F  (  2,  3)  = 


TEE  ELEMENT  F(  l.  1)  = 
7 

-6 

THE  ELEMENT  F (  3,  2)= 
7 

-11 

TEE  ELEMENT  F(  3,  3)  = 


THE  SYSTEM  M ATRIX  "F"-MATRIX  ... 

C.C  1.QCC00  0.0 

C.O  0.0  1.00000 

-e.ccooo  -n.occoo  -6.C0000 

DO  YCU  WISH  TO  CHANGE  THE  VALUE  OF  ANY  MATRIX  ELEMENT 
TYPE  "YES”  CB  "NO", 
n 

OPEN  LCCP  DYNAMICS  MATRIX . F.  . 

0.0  0.  IOOCl  +  0 1  0.0 

O.C  0.0  0.  1000D+01 

-0.60C0I>01  -0.1 10CE+02  -C.6000D+01 

OPEN  IOCP  EIGENVALUES . DET(SI-F).. 

- 1.00CCQI*0C:-2. 000 001*00: -3. 00000D+00: 
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CPE N  ICCP  FIGHT  EIG  E  N  VECTOR  MATRIX . T 

-5. 77  35  C3I- £  1  -  2. 1 82  17SD-01  1 .C482650-C t 

5.7735C3D-C1  4.364  356D-01  -3 . 1 44855 D-0 1 

-5.  7735 03E-C1  -  8 .723 7  16D-0 1  S.434564D-01 


OPEN  ICCP  LEFT  EIGENVECTOR  MATEIX . T-INV.  . 

-5. 196  152E  +  CO  -  4.330  127D+00  -8 .6602540- 01 
1. 374773D+C1  1.833C30D+01  4.582576D+00 

9.53S392E+00  1.430SC9D+01  4.769696D+00 

ANALYSIS  COMPLETE.  DO  YOU  WANT  ANOTHER  RUN? 

TYPE  “YES''  OR  "NO”. 

10 

. CPTSYSX  IS  NCfc  TERMINATED . 

E ;  1=  C  .26/0  .89  21:52  :08 
record  off 

END  EECCEDI NG  OF  TERMINAL  SESSION 

E.  E EGULATCR  SYNTHESIS 

The  following  regulator  synthesis  example  was  taker,  from 
"Lecture  Notes  on  Advanced  Control  Systems",  by  Professor 
E . J .  Ccllixs  of  the  Naval  Postgraduate  School,  Monterey, Ca. 
This  example  involved  deter ninaticn  of  the  optimal  regulator 
gains  fcased  on  an  artitrarily  chosen  quadratic  index;  with 
the  various  system  arc  cost  matrices  described  below. 

Examination  cf  the  extensive  program  output  indicates 
that  the  optimal  regulator  gains  are:  -5.0  and  -SQRT(IC.C). 
The  alcetraic  sign  cf  the  gains  is  consistent  with  the  defi- 
riticr  displayed  on  the  first  screen  of  the  program  (pa. 
34)  . 

The  full  terminal  session  is  recorded  below,  with  user 
input  in  lower  case  letters  following  each  . 

record  cr 

EEGIN  £ E COE  LIN G  CF  TERMINAL  SESSION 
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E;  T*C.G1/C.02  1  3:55:26 

C6  t?rta  (r«cfir  fa  blksize  133 
global  titlib  fortmodl  nod2€sh  imslap  ronimsi 
load  c£zsys:<  (start 
EXEC  C 1IC  N  BEGINS... 

CP1SYSX  IS  A  COMPLETELY  INTERACTIVE  OPTIMAL  SYSTEMS  CONTROL 
EFCGFAM.  IT  HILL  SOLVE  NUMEROUS  COUIROl  PROBLEMS  CK  TEE 
FCILCHIKG  TYPES  CE  SYSTEMS  CCNTRCL  EQUATIONS: 

X COT  =  (F)  *X  +  <G)*U  +  (GAM)  *  (W+  WO) 

MEASCFEMENT  EQUATION  — 

Z  =  (  H)  *  X  +  (D) *a  ♦  V 

PEGUIATCB  PERFORMANCE  INDEX  — 

J  =  1/2  *  INTEGRAL  (Yt*(A)*Y  ♦  Ut*(B)*U)CT 
STATE  FEEDBACK  GAIN  DEFINITION  — 

U  =  -(C)  *X 

DC  YCU  WISH  TC  CONTINUE?  TYPE  "YES"  OB  "NO". 


—  LATA  ENTRY  — 

AITECUGH  OPTSYSX  IS  SPECIFICALLY  DESIGNED  TO  BEAD 
AIL  MATRIX  DATA  INTERACTIVELY,  SEVERAL  ALTERNATE 
MFTECCS  ARE  AVAILABLE  TO  USERS: 

METKCE  1 — THE  "F","G",  AND  "GAMMA"  MATRICES 

MAY  EE  READ  FECM  SEPARATE  DATA  FILES. 
METHOD  2 — THE  "F","G",  AND  "GAMMA"  MATRICES  MAY  BE 

EXPLICITLY  DEFINED  WITHIN  SUBROUTINE  "SETUE". 
(NCTE :  IN  EITHEF  CASE,  TEE  USER  SHOULD  OBTAIN  A  CCPY 
OF  THE  EROGRAM  LISTING  AND  EXAMINE 
THE  EXAMPLES  CONTAINED  IN  S/R  "SETUP".) 

DO  YOU  WISH  TC  CONTINUE?  TYPE  "YES"  OR  "NO". 


EC  YOU  WISH  TC  INPUT  T BE  "F",  "G",  AND  "GAMMA" 
MATRICES  FICM  SU8BOUTINE  "SETUP"  IAW  THE 
METHOD  DESCRIBED  CN  THE  PREVIOUS  SCREEN? 

TYPE  "YES"  OF  "NO". 


CETION  1 


GENERAL  CETSYSX  GPTIQNS: 

--  SYSTEM  ANALYSIS  WITHOUT 

OPEN-  ICC  P  EIGEN  SYSTEM  C  ALCULATIC  :i 
C2IION  2  —  SYSTEM  ANALYSIS  WITH  CP  Ell- LOCI 
EIGEN  SYSTEM  CALCULATIONS. 

CITION  3  —  OPEN- LOOP  EIGENSYSTSM  FOUND 
AND  PBCGPAM  TERMINAT ES. 

("F"-KAI?.IX  ENTRY  FOLLOWS  IMMEDIATELY. ) 
CITION  4  --  MODAL  DIST BI3UTI0 11  MATRICES  COMPUTED 
WITHOUT  FILTER  OR  REGULATOR  SYNTHESIS 
OB  STEADY-STATE  ANALYSIS. 

SELECT  AN  OPTION:  1,2,3,  OS  4. 


c 


to 


1 

1 


EC  YCU  DESIRE  RES  VALUES  CF  STATE  AND  CONTROL? 

TYPE  "YES"  CR  "NO". 

CPTSYSX  LQB /CLASSICAL  OPTIONS: 

CITION  1  --  OPTIMAL  FILTER  ANC/Ofi  REGULATOR 

SYNTHESIS  WITH  NO  EXTERNAL  "C"  CR  "K" 
MATRIX  INPUT. 

CETION  2  --  OPTIMAL  FILTER  AND/OR  REGULATOR 
SYNTHESIS  WITH  EXTERNAL  "C" 

MATRIX  INPUT. 

CETION  3  --  OPTIMAL  FILTER  AND/OR  REGULATOR 
SYNTHESIS  WITH  EXTERNAL  "K" 

MATRIX  INPUT. 

CETION  4  --  OPTIMAL  FILTER  AND/OR  REGULATOR 

SYNTHESIS  WITH  EXTERNAL  "C"  AND  "K" 
MATRIX  INPUT. 

SELECT  AN  CITION:  1,  2,  3,  OB  4. 


DO  YCU  WISH  TO  DETERMINE  THE  STEADY-STATE  RESPONSE 
FCB  A  CONSTANT  DISTURE ANCE? 
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r.o 


GO 


? 

1 


TYPE  "YES"  CP  "NO". 

IC  YCU  WISH  TC  IETESMISE  THE  MODAL  DISTEIBUTICV 
AND  OAT  u  MAT  F ICES? 

TYPE  "YES"  CS  "HO". 

OPEN-LOOP  TRANS PER  FUNCTION  OPTIONS: 

CETICN  1  —  NC  OPEN- ICC E  TRANS FEE  FUNCTIONS  COMPUTED. 
CETICN  2  —  POLES,  RESIDUES,  AND  ZEROS  CONFUTED. 
CPTICN  3  —  OilY  POLES  AND  ZEROS  COMPUTED. 

CETICN  4  —  ONLY  POLES  END  RESIDUES  COMPUTED. 

SELECT  AN  CETICN:  1,  2,  3,  OR  4. 


1 

1 


NOISE  TReKSEEP  FUNCTION  OPTIONS: 

CETION  1  --  NC  NOISE  TRANSFER  FUNCTIONS  COMPUTED. 
CETION  2  —  PCLSS,  RESIDUES,  AND  ZEROS  COMPUTED. 
CPTION  3  —  CKIY  POLES  AND  ZEROS  COMPUTED. 

OPTION  4  --  ONLY  POLES  AND  RESIDUES  COMPUTED. 
SELECT  AN  CPTION:  t,  2,  3,  OR  4. 


CC  MEENSATOR  TRANSEER  FUNCTION  OPTIONS: 

CPTION  1  —  KC  COMP .  TRANSFER  FUNCTIONS  COMPUTED. 
CETION  2  —  ECLES,  RESIDUES,  AND  ZEROS  COMPUTED . 
CPTION  3  —  CSIY  POIES  AND  ZEROS  COMPUTED. 

CPTION  4  —  CNLY  POIES  AND  RESIDUES  COMPUTED. 


(NOTE:  A  COMPENSATOR  TRANSFER  FUNCTION  CAN  EE 
COMPUTED  ONLY  IF  BOTH  A  REGULATORAND 
FI  ITER  ARE  SYNTHESIZED  AND/CR  INPUT.) 
SELECT  AN  CETION:  1,  2,  3,  OR  4. 

? 

1 

Sill  A  FESD-FORSiRD  DISTRIBUTION  MATRIX 
("E"  -  MATRIX)  BE  INPUT  ? 
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TYPE  "YES"  OE  "SC". 


THIS  C  E IIC  N  DETEHMI  SIS  THE  CRITERIA  FOR  DECIDING  Vi  HE  I. 


HA3RCV  lAEAMZi: 


**  *  T*  *  *  fy  *t  n  •  ?  •  '"“T?  " 

Dn..  aw  *  £:  .«  A. 


THE  CBDEE  CF  THE  NU AERATOR  PCIY  NCHIAL  OF  EACH  TRANSFER 
EUNCTICN. 

AIL  "N«  ZEROS  OF  THIS  POLYNOMIAL  ARE  PRINTED  OUT  AND 
TfcIS  TEST  TELLS  FCW  MANY  EXTRA  ROOTS  EXIST  AT  Z  =  0. 
IESS  THAN  10.0**  (-IE)  IS  CONSIDERED  ZERO. 

TEE  DEEA.ULT  VALUE  CF  THIS  PARAMETER  (IE)  IS  6. 

IS  CTHSR  WORDS,  IE  =  1.GE-6. 

IF  YCU  DESIRE  A  DIFFERENT  MARKOV  CRITERIA,  TYPE  THE 
INTEGER  VALUE. 

IF  YCU  DESIRE  THE  DEFAULT  VALUE,  TYPE  "0"  (ZERC) 


DO  YCU  DESIRE  TO  SYNTHESIZE  A  STABLE  FILTER  (OR  REGGIATOE) 
BY  CESTAEI1IZI NG  THE  ORIGI SAL  SYSTEM? 

(NOTE: WORKS  FCB  FILTER  OR  REGULATOR  BUT  NOT  FCR  EOTH 
IN  THE  SAME  RUN.) 

TYPE  "YES"  CR  "NO". 


DC  YOU  DESIRE  TC  PRINT  THE  EULER-LAGRANGE  EIGENSYSTER 
ERICR  TO  DECOMPOSITION  (EOR  CHECKING  THE  PROGRAM)? 
TYPE  "YES"  CR  "NO". 


ECWES  SPECTRAL  DENSITY  (PSD)  OPTION  1  : 

CETICN  1  —  COMPOTE  THE  PSD  OF  THE  OUTPUTS  AND/CR  THE 
CONTBCLS  OE  TEE  CONTROLLED  SYSTEM  WEEN 
FORCED  BY  PROCESS  AND  MEASUREMENT  NCISE. 
(NOTE:  ECTH  A  REGULATOR  AND  A  FILTER  MUSTEZ 
RESIDEN1  IN  THE  EROGRAM  TO  USE  THIS  OPTICS.  ( 
CEIICN  2  —  SAME  AS  OETICN  1  ABOVE  BUT  ONLY  PRINT  TEE 
RESIDUES  CF  EACH  TRANSFER  FUNCTION 
USED  IN  THE  ESD  COMPUTATION. 


CETICS  3 


NOT  ZES1RID 


S ELECT  AH  CETION:  J,  2,  OS  3. 


CC  YCU  DESIRE  3EGULAT05  SYNTHESIS  ONLY? 

TYPE  "YES”  CF.  "HO”. 

yes 

IHIia  TEE  #  OF  STATES  (HS)  CF  THE  SYSTEM  MATRIX 
("*•'- f.AT SIX)  . 


EHTIE  TEE  #  OF  CONTEOLS  (  NC)  OF  THE  CONTROL  SYSTEM  KCEEI 
( ”G” -MATBI X)  . 


ENTER  THE  #  OF  MEAS  L'HEMENTS  C3  OBSERVATIONS  (HO)  OF  THE 
(" fi"-EAT BIX)  . 

7 

2 

ENTIF  TfcE  *  OF  FF.OCESS  HOIST  SOURCES  ( NG)  OF  THE 

("GAMES" -  MATS  IX). 

? 

C 

EUG/EAFAMETER  SETTINGS  FOB  THIS  RUN  ARE  AS  FOLLCNS: 
IOL  IC  IE  ISS  IM  ITF1  ITF2  ITF3  IFDFW  IE  IEEEUG 
10C0C0  0  0  0  01 

I SET  IDSIAE  IPSO  IYU  INCSM  IRSG  NS  NC  NOB  NG 
0  C  OC  0  12120 

ORDEE  CF  SYSTEM  =  2 

NOMEEB  CF  CONTROLS  *  1 

NUMEEB  CF  CBSEEVATICFS  *  2 

NOMEEB  CF  EBOCESS  NCISE  SOURCES  =  0 

ENTER  THE  SYSTEM  MATRIX  "F”-MAT2IX 

DIMENSION  *  #  STATES  (NS)  X  #  STATES  (NS) 

TEE  ELEMENT  F(  1,  1)* 
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c 


THE  ELEMENT  F  (  1,  2 )  = 

% 

1 

1 E  £  ELEMENT  F(  2,  1)* 

•5 

0 

3BE  ELEMENT  F (  2,  2) = 

■> 

C 

THE  SYSTEM  MATRIX  "F"-MATRIX  ... 

C.O  1.0CC00 

C.O  0.0 

DC  YCC  «ISH  TC  CHANGE  THE  VALUE  OF  ANY  MATRIX  ELEMENT? 
TYPE  "YES"  CR  "NO". 

EO 

CEE N  LCCP  DYNAMICS  MATRIX . F.  . 

O.C  0.10Q0C+01 

0.0  0.0 

CEE N  LCCP  EIGENVALUES . DET  (SI-F)  .  . 

0.0  z  Q  •  Q  z 

CEE N  LCCP  RIGHT  EIGENVECTOR  MATRIX . T - 

1. OCOOOCE+OO  -1.000CCCD+0Q 
0.0  2 .22  0446D-16 

CEE N  LCCP  LEET  EIGENVECTOR  MATRIX . T-INV. . 

1. OCCCCCD+CO  4 .5  03  6C0D+1 5 
0.0  U.5036C0D+15 

ENTER  THE  MEASUREMENT  SCALING  MATRIX  "H"-M ATRIX  . 

DIMENSION  =  I  OBSERVATIONS  (NO)  X  #  STATES  (NS) 
TEE  ELEMENT  H(  1,  1)* 


? 

1 
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THE  ELEMENT  H (  1,  2)  = 


2 

C 

Its  ELEMENT  H(  2,  1)  = 

* 

0 

THE  ELEMENT  H  (  2,  2)  = 

2 

1 

TEE  MEASUREMENT  SCALING  MATRIX  "H"-MATRIX  ... 
1.CC0CC  0.0 

C.O  1.0CC00 

10  JCU  WISH  TO  CHANGE  THE  VALUE  OF  ANY  MATRIX  ELEMENT? 
TYPE  M  YES "  CR  "NO”. 

EO 


MEASUREMENT  SCALING  MATRIX . H.  . 

0. 10C0C+01  0.0 

O.C  0.10  0  CE+0 1 

• 

ENTER  THE  OUTPUT  MEASUREMENT  COST  MATRIX  ”A”-MATfiIX  . 
El  ME  N SION  =  *  CESERVATICNS  (NO)  X  #  CESERVATICNS  (NO) 
TEE  ELEMENT  A(  1,  1)  « 

1 

25 

THE  ELEMENT  A(  1,  2)  = 

* 

m 

c 

TEE  ELEMENT  A  (  2,  1)  = 

t 

0 

THE  ELEMENT  A(  2,  2)- 

2 

C 

TEE  CUTPUT  HEASUFEMENT  COST  MATRIX  " A”- MATRIX  ... 
25.CCC0C  0.0 

4  C 


C.O  0.0 

DC  YCC  WISH  TO  CHANGE  THE  VALUE  OF  ANY  HATS IX  117. -.-Y 
TYPE  "YES"  CP  "NO*'. 


CUTEUT  COST  MATRIX . A 

C.2SC0D+02  0.0 

0.0  0.0 


ESTES  THE  C  CNT3CI  DISTRIBUTION  L.-.T  EIX  "  3"-;I  AT  c  IX 
DIMENSION  =  4  STATES  (NS)  X  4  CONTROLS  (NC) 
TEE  ELEMENT  G(  1,  1)  = 


0 


THE  ELEMENT  G (  2,  1)= 


1 

TEE  CONTROL  DISTRIBUTION  MATRIX  "G"- MATRIX  . .. 

C.O 

1.CC00C 

DC  YCC  WISH  TC  CHANGE  THE  VALUE  OF  ANY  MATRIX  ELEMENT? 
TYPE  "YES"  CR  "NO". 

EO 

ESTER  I HE  CCNTRCI  COST  WEIGHTING  MATRIX  "B"-MAISIX 
DIMENSION  =  I  CONTE  CIS  (NC)  X  4  CONTROLS  (NC) 
TEE  ELEMENT  B(  1,  1)  = 

1 

1 

TEE  CQNTfiCI  COST  EAIRIX . E... 

1.00000 

DO  YCC  WISH  TO  CHANGE  THE  VALUE  0?  ANY  MATRIX  ELEMENT? 
TYPE  "YES"  CR  "NO". 


CO 

TEE  CONTROL  DISTRIBUTION  MATRIX . G 


4  1 


O.C 

0.  10C0I+0  1 


TEE  CONTROL  COST  MATRIX 


B 


0. 1CCCC+01 


EUIEE-LAGRANGE  SYSTEM  MATRIX... 


o 

• 

o 

1 .000CC0D+00 

o 

• 

o 

0.0 

o 

• 

o 

0.0 

0.0 

-1 . C0C00CD+03 

2. 5CC0CCD+C1 

0.0 

0.0 

0.  0 

0.0 

0.0 

-  1 .  COOOOQD*  00 

0.0 

EIGENVALUES  AMD  EIGENVECTORS  C?  THE  2N  X  2S 
E U I ER-L AGEAN GE  SYSTEM  AET 13  HQR2 . 

-1.581 13SD+  CO  1 .581  1  39D+00 
-1.  5  8  113SC+C0-  1.581 1  2SD  +  00 
1.581 1 3SD+  CO  1.581 13SD+00 

1.  58 113SE+C0-  1.581  125D  +  00 

-7.43C443D-C2  7.168812D-02  -1 .824925D-0  1  - 1 .  50348 2D-0  1 

4.  1367S5E-C3  -  2 .308 245D-0 1  -5 .Q82459D-C2  -5. 2626 75D-0  1 
-1.15H172D+C0  -2.068377D-02  2.631337D+00  -2. 54 1 22 S B-0  1 

-3.  5844C6C-C 1  -  3 . 7  1 5 2 22D-0 1  -7.5  174  12D-0  1  9.  124627D-01 

EIGENSYST2M  CF  CE1IMAL  REGULATOR . 

EIGENVECTORS  FROM  RGAIN  E5IOR  TO  CNOSM 
-1.45SS25D-C1  -2 .6 163  13D-03 

2.  3457  12E-Q1  -  2 . 266 S77D-0 1 

C-LCCE  CETIMAL  BEG.  E- VALUES.  ..  DET(SI-F*G*C)  .  . 

-1.  58  1 141*00,  1.581  1  41*00: 

C-LCCF  EIGHT  EIGENVECTOR  MAIRIX . M. _ 

-3. 162278D-C1  -3.162278D-01 
1. 0G00CCD*C0  0.0 

C*M.  . 


CCSTECI  EIGENVECTOR  MATRIX 
1.58113SD+0Q  1.5811 39D  *00 


C-LCCP  CPT.  BEG.  LEFT  E-VECTOB  MATEIX. . M-INV. . 

0.0  1 .0  00  CC0D+00 

-3.  U227EC  +  C0  -  1 .000  CCCD  +  CO 

«u£i  **  W  Jm  -i.  *™  «  4.  *  .  »-l  ^  ..  i1-  '  J  (i «-  •  *  C  C  ^  i*  .i  <'■  «  r>  \  J  .  ’  <  K  *"  *T-  •  .  • 

-5.0CCCI+C0  -3.1623E+00 

T8E  CLOSED  LCOP  DYNAMICS  MATBIX . F-G*C. . 

0.0  1.000CCCD+00 

-5.0CCCCCD*C0  -3.162278D+00 

ANALYSIS  COMPLETE.  EO  YOU  WANT  ANOTHER  EON? 

TYPE  "72S"  OB  "NO", 
no 

- . OPTSYSX  IS  NOW  TERMINATED . 

E;  T*C.  42/1.85  14:Q3:C3 
record  off 

END  EECCEEING  OF  TERMINAL  SESSION 

C.  FllIIS  SYNTHESIS 

The  following  Kalaan  filter  synthesis  example  was  taker, 
from  "lectcre  Notes  on  Advanced  Control  Systems”,  by 
Professor  E.J.  Collins  of  the  Naval  Postgraduate  School, 
Hontexe j,Ca. 

This  example  involved  determination  of  the  optical 
filter  gains  of  an  arbitrary  system;  modeled  nearly  identi¬ 
cally  tc  the  previous  regulator  problem. 

In  its  present  configuration,  OPTSYSX  program  sequencing 
xeguixes  the  design  of  an  optimal  regulator,  prior  to 
performing  any  optiaal  estimator  synthesis.  In  order  to 
comply  with  built-in  program  sequencing  conventions,  and 
circumvent  program  difficulties  which  may  not  be  specified 
in  the  particular  system  model,  optimal  filter  synthesis  may 
he  accomplished  hy  entering  the  identity  matrix  [I]  in  these 


program  incut  sequences  requiring  the  entry  of  ?:  cr.rr 
ccst  iahting)  matrix.  Although  tr»e  optimal  ,1a  :c: 
calculators  auj  diiter  free  these  expected,  the  cptirnl 
jstijatti  calculaticrs  will  he  correct  for  the  system  icd-l. 

Examination  cf  tie  extensive  program  output  indicates 
that  the  optimal  filter  gains  are:  -5.0,  and  -SQRT(2.0). 

lie  full  terminal  session  is  recorded  below,  with  user 
input  in  lower  case  letters  following  aach  "?"  . 

record  cr 

EEGIN  FECCBEING  CF  TEFMINAL  SESSION 

B;  T=C.  0  1/0.02  21:49:30 

filedef  C6  term  (iecfi  fa  blksize  133 

global  txtlib  fortmod2  mcd2eeh  issidp  ncnimsl 

lead  cptsysx  (start 

EXECUTION  E  EGINS  ..  . 

OPTS YSX  IS  A  COMPLETELY  IN  TER ACTIVE  OPTIMAL  SYSTEMS  CCKTECL 
PROGRAM.  IT  WILL  SOLVE  NUMEROUS  CONTROL  PROBLEMS  ON  THE 
ECLICKING  TYPES  CF  SYSTEMS  CONTROL  EQUATIONS: 

,  XDOT  =  (F)*X  ♦  (G)  *U  ♦  (G AM)  *  ( W  +  W  0) 

MEASUREMENT  EQUATION  — 

Z  =  (H)  *X  *  (D)  «•  V 

REGULATOR  PERFORMANCE  INDEX — 

J  =  1/2  *  INTEG6AL  (Yt*(AJ*Y  ♦  Ut*(B)*U)ET 
STATE  FEEDEACK  GAIN  DEFINITION — 

U  =  -(C)  *x 

CO  YOU  WISE  TO  CONTINUE?  TYPE  "YES"  OR  "SC". 

yes 

--CA1A  ENTRY— 

A1IHG0GH  OPTSYSX  IS  SPECIFICALLY  DESIGNEE  TO  HEAD 
ILL  MATRIX  EATA  INTERACTIVELY,  SEVERAL  ALTERNATE 
METHODS  ARE  A V AIIABLE  TC  USERS: 

METHOD  1 — THE  HE","G",  AND  "GAMMA"  MATRICES 
MAY  BE  BEAD  FRCS  SEPARATE  DATA  FILES. 

METHOD  2 — THE  "F","G",  AND  "GAMMA"  MATRICES  BAY  EE 
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EXPIICI1IY  DSF IhEE  WITHIN  SUBROUTINE  "SETUP" 
(SCTE:  IN  SHEER  CASE,  THE  USER  SHOULD  OBI  AIN  A  CO 
OF  THE  FROG E A 2  LISTING  AND  EXAMINE 
THE  EXAMPLES  CONTAINED  IN  S/E  "ELIUr’*.; 
EC  YOU  WISH  TC  CONTINUE?  TYPE  "YES"  CR  "NO". 


yes 

EO  ICO  WISH  TO  INPUT  THE  »F",  "G»,  AN  D  "  GAUM  A” 
MATRICES  FECK  SUBROUTINE  "SETUP"  IAN  THE 
METHOD  DESCRIBED  CK  THE  PREVIOUS  SCREEN? 

TYPE  "YES"  OR  "NO", 

no 

GENERAL  CPISYSX  OPTIONS: 

CETION  1  —  SYSTEM  ANALYSIS  WITHOUT 

CFZN-LOCP  EIGEN  SYSTEM  CALCULATIONS. 
OPTION  2  —  SYSTEM  ANAIYSIS  WITH  OPEN-LOOP 
EIGENSY  STE B  CALCULATIONS. 

OPTION  3  —  CPEN-LOCE  EIGENSYSTEM  FOUND 
AND  PROGRAM  TERMINATES. 

("FM-i!ATEIX  ENTRY  EOLLOWS  IMMEDIATELY.) 
OPTION  4  —  MODAL  DISTRIBUTION  MATRICES  COMEUTED 
WITHOUT  FILTER  OR  REGULATOR  SYNTHESIS 
OF  STEADY-STATE  ANALYSIS. 

SELECT  AN  OPTICS:  1,2,3,  CR  4. 

1 

1 

10  YOU  DESIRE  RMS  VALUES  OF  STATE  AND  CONTROL? 

TYPE  "YES"  OR  "NO". 


no 


CPTSYSX  LQF/CLASSICAL  OPTIONS: 

OPTION  1  --  OPTIMAL  FILTER  AND/OR  REGULATOR 

SYNTHESIS  WITH  NO  EXTERNAL  "C"  OR  " 
MATRIX  INPUT. 

OPTION  2  --  OPTIMAL  FILTER  AND/OR  REGULATOR 
SYNTHESIS  WITH  EXTERNAL  "C" 

MATRIX  INPUT. 
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OPTION  3  —  OPTIMAL  FILTER  AND/OR  REGULATOR 
SYNTHESIS  WITH  EXTERNAL  "K" 

MATRIX  INPUT. 

C  F  TT  C !'  4  --  r.?Tx«  At  FIITr.R  AND /OR  R EGiJ T.  '  ~r  ^ 

SYNTHESIS  WITH  EXTERNAL  MCM  AND  "K" 
MATRIX  INPUT. 

SELECT  AN  OPTION:  1,  2,  3,  OR  4. 

? 

1 

DC  SCC  WISH  TO  DETERMINE  THE  STEADY-STATE  RESPONSE 
FCK  A  CONSTANT  DISTURBANCE? 

TYPE  “YES"  CR  "NOM. 
no 

CO  SOU  WISH  TO  DETERMINE  THE  MODAL  DISTRIBUTION 
AND  GAIN  MAT F ICES? 

TYPE  M YES "  CR  "NO«. 
no 

CPEN-ICCP  TRANSFER  FUNCTION  OPTIONS : 

OPTION  1  --  NO  CPEN-LCOP  TRANSFER  FUNCTIONS  CONFUTED 
OPTION  2  --  POIES,  RESIDUES,  AND  ZEROS  COMPUTED. 
OPTION  3  —  ONLY  POLES  AND  ZEROS  COMPUTED. 

OPTION  4  —  ON  I Y  POLES  AND  RESIDUES  COMPUTED. 

SELECT  AN  OPTION:  1,  2,  3,  OS  4. 

? 

1 

NOISE  TRANSFER  FCNCTIOS  OPTIONS: 

OPTION  1  --  NO  NOISE  TRANSFER  FUNCTIONS  COMPUTED 
OPTION  2  —  POLES,  RESIDUES,  AND  ZEROS  COMPUTED. 
OPTION  3  --  ONLY  POLES  AND  ZEROS  COMPUTED. 

OPTION  4  --  ONLY  POLES  AND  RESIDUES  COMPUTED. 
SELECT  AN  OPTION:  1,  2,  3,  OR  4. 

? 

1 

COMPENSATOR  TRANSFER  FUNCIICN  OPTIONS: 

OPTION  1  --  NO  COMP.  TRANSFER  FUNCTIONS  COMPUTED. 
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7 

1 


CPTION  2 

CPTION  3 
CPTION  4 
(KOT2 


—  KIES,  RESIDUES,  AND  ZEROS  COMPUTED. 
--  CNLY  POLES  AND  ZEROS  COMPUTED. 

—  CMY  POLES  AND  RESIDUES  COMPUTED. 

:  A  CCMf  l’JS  ATOF  transfer  function  can  if 
COMPUTED  CMY  If  BOTH  A  REGULATOR 
AND  FILTER  ARE  SYNTHESIZED 


AKD/C5  INPUT.) 


SELECT  AN  OPTION:  1,  2, 


OR  4. 


Bill  A  FEED -FOR  fc  AHD  DISTRIBUTION  MATRIX 
"D"  -  MATRIX  EE  INPUT  ? 


TYPE  "YES"  OB  »NC". 


no 

THIS  CFTICN  DETERMI  MS  THE  CEITERIA  FOR  DECIDING  WEEN 
A  HABKCV  PARAMETER  IS  ZERC-IHE  MARKOV  PARAMETER 
INDICATES  THE  CRD E F  OF  THE  NUMERATOR  POLYNOMIAL  OE  EACH 
TRANSFER  FUNCTION, 

ALL  "N"  ZEROS  C F  THIS  POLYNOMIAL  ARE  PRINTED  OUT  AND 
THIS  IEST  TELLS  HCW  MANY  EXTRA  ROOTS  EXIST  AT  Z  =  0. 

LESS  THAN  10.0**  (-IE)  IS  CONSIDERED  ZERO. 

THE  DEFAULT  VALUE  CF  THIS  PARAMETER  (IE)  IS  6. 

IN  CTHEB  WORDS,  IE  *  1.QE-6. 

IF  YOU  DESIRE  A  DIFFERENT  MABKCV  CRITERIA, 

TYPE  TEE  INTEGER  VALUE. 

I?  YOU  DESIRE  THE  DEFAULT  VAIUE,  TYPE  "0"  (ZERO) 

■j 

• 

C 

DO  ICU  DESIRE  TO  SYNTHESIZE  A  STABLE  FILTER  (OR  REGULATOR) 
BY  DESTABILIZING  THE  CRIGI NAL  SYSTEM? 

(NOTIjWCRKS  FOR  EILTER  CR  REGULATOR  BUT  NOT  FOR  ECTH 
Iti  THE  SAME  GUN.) 

TYPE  "YES"  CR  "NO". 


CO 
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EC  YCU  DESIFE  TC  PRINT  THE  EULER-LAGRANGE  EIGEN SYSTEM 
ERICS  TO  DECCB POSIT  ION  (FOR  CHECKING  THE  PPCGPAG? 

TYPE  “YES"  CR  “NO", 
no 

ICSES  SPECTRAL  DENSITY  (PSD)  OPTION  1  : 

CPTICN  1  --  COMPUTE  THE  PSD  OF  THE  OUTPUTS  AND/CR 
THE  CONTROLS  OF  THE  CONTROLLED  SYSTEM 
WHEN  FORCE  I  EY  PROCESS  AND  MEASUREMENT 
NOISE.  (NGIZ:  BOTH  A  REGULATOR  AND  A 
FILTER  MUST  EE  RESIDENT  IN  THE  PROGRAM 
TO  CSE  THIS  OPTION.) 

CETICN  2  —  SAME  AS  OPTICS  1  ABOVE  BUT  ONLY  PRINT  THE 
RESIDUES  OE  EACH  TRANSFER  FUNCTION 
USED  IN  THE  PSD  COMPUTATION. 

CPT1CN  3  —  NOT  DESIRED. 

SELECT  AN  CETICN:  1,  2,  OR  3. 


CC  YCU  DESIRE  REGULATOR  SYNTHESIS  ONLY? 

TYPE  "YES "  CR  "NO", 
no 

ENTER  THE  #  OF  STATES  (NS)  OF  THE  SYSTEM  MATRIX 
«x"-MATRIX  . 


ENIER  TEE  #  OF  CCNTROLS  (NC)  OF  THE  SYSTEM  MODEL 

"G"-M ATRIX  . 

? 

1 

ENTER  I BE  #  OF  HIASURB BENTS  OR  OBSERVATIONS  (NO) 
"H"-BATRIX  . 

1 

1 

ENIER  THE  #  OF  PROCESS  NOISE  SOURCES  (NG) 
"GAB81"-HATRIX  . 
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FLAG /PARAMETER  SETTINGS  FCF  THIS  RUN  ARE  AS  FCLiCM 
IOL  ic  IE  ISS  IM  IIP  1  IIF  2  ITF3  IFOF'rf  II  I  III 
00C000  0  0  0  0  0 

2SET  2LST  A E  IPSD  310  IN  CRM  IREG  NS  NC  N03  NG 
0  C  OC  0  02110 

CRCEF  CF  SYSTEM  =  2 

NUMBER  CF  CONTROLS  =  1 

NDMEER  CF  OBSERVATIONS  =  1 

NUMEEB  CF  ERG  CESS  NOISE  SOOBCES  =  0 

ENTER  THE  SYSTEM  MATRIX  "F"-MATRIX 

DIMENSION  =  *  STATES  (NS)  X  #  STATES  (NS) 

TEE  ELEMENT  F(  1,  1)  = 
x 
0 

THE  ELEMENT  F(  1,  2)  = 

•5 

1 

TEE  ELEMENT  F<  2#  1)  = 

■3 

• 

0 

THE  ELEMENT  F (  2,  2)= 

? 

C 

THE  SYSTEM  MATRIX  "F"-MATRIX  ... 

C.O  1.00000 

0.0  0.0 

DO  ICC  KISH  TO  CHANGE  THE  VAIUE  OF  ANY  MATRIX  ELEMFNT 
TYPE  "YES"  OR  "NO". 

CO 

CFEN  LOOP  DYNAMICS  MATRIX . F.  . 


0.0 


0.10QCE+01 


0.  0 


0.0 


ES  125  THE  MEASUREMENT  SCARING  MATRIX  "H"-M AT3IX  . 

EIMESSIGN  =  a  CBS  EH  V  AT  ICIii  (NC)  X  #  STATES  (V.Z) 
TEE  ELEMENT  H(  1,  1)  = 


IE E  ELEMENT  H {  1,2)  = 

2 

C 

TEE  MEASUREMENT  SCALING  MATRIX  "H"-MATRIX  ... 
1.CC0CC  0.0 

CC  ECU  WISH  TO  CHANGE  THE  VALUE  OF  ANY  MATRIX  ELEMENT? 
TYPE  "YES"  CE  "NO", 
no 

MIAS  CEE  KENT  SCALING  MATEIX . H.  . 

0.1CC0E  +  01  0.0 

ENTER  IHE  OUTPUT  MEASUREMENT  COST  MATRIX  "A” -MATE IX  . 
DIMENSION  *  #  OESERVAT ICNS  (NO)  X  #  OBSERVATIONS  (NO) 
TEE  ELEMENT  A(  1,  1)  = 

? 

1 

THE  CCTEUT  KEAS CLEMENT  CCST  MATRIX  "A"-MATRIX  ... 
1.CC00C 

CC  YCU  WISH  TO  CHANGE  THE  VALUE  OF  ANY  MATRIX  ELEMENT? 
TYPE  "YES'*  CR  «NO". 
no 

CCIECI  COST  MATRIX . A.. 

0.  10C0E+0  1 

ENTER  THE  CCNTBCI  DISTRIBUTION  MATRIX  "G,,-MATRIX  . 

DIMENSION  =  *  STATES  (NS)  X  *  CONTROLS  (NC) 

TEE  ELEMENT  G(  1,  1)  = 


? 

0 


5C 


TEE  ELEMENT  G<  1,  1)  = 


0 

1  HE  CCNTRCI  DISTRI5UTIG  N  MATRIX  "G"-MATEIX  ... 
C..C 
0.0 

DC  YCC  WISH  TC  CHANGE  THE  V AID E  OF  ANY  MATRIX  ELEMENT? 
TYPE  "YES"  C&  "NO " . 

yes 

ENTER  THE  RCW  H CEE EB  OF  THE  ELEHENT  TO  BE  CHANGED. 

? 

2 

ENTER  THE  COLUMN  NUMBER  CE  THE  ELEMENT  TO  BE  CHANGED. 

? 

1 

THE  ELEMENT  G(  2,  1)  = 

"j 

• 

1 

THE  CONTROL  DISTRIBUTION  MATRIX  «G"-HATBIX  ... 

C.O 

1.CCOOO 

DC  YCC  KISH  TC  CHANGE  THE  VALUE  OF  ANY  MATRIX  ELEMENT? 
TYPE  "YES"  CR  "NO". 

EO 

ENTER  THE  CCNTRCI  COST  WEIGHTING  MATRIX  "B"-MA1RIX 
DIMENSION  =  #  CONTECIS  NC  X  *  CONTROLS  NO 
THE  ELEMENT  3 (  1,  1)= 

1 

? 

TEE  CCNTRCI  COST  EAT  BIX . B... 

1-CC000 

DC  YOU  WISH  TO  CHANGE  THE  VALUE  OF  ANY  MATRIX  ELEMENT? 
TYPE  "YES"  CR  "NO", 
no 


51 


TEE  CONTROL  DISTE1BUTIO  N  MATRIX 
O.C 

0.  1CCCI+0  1 

THE  CCi.il  A-J  L  COST  *  A I II X........ 

0.  1CCCC  +  0  1 

EIGENS Y  STEM  CF  CETIMAL  REGULATOR . 

C-ICC?  OPTIMAL  REG.  E-  V  ALU  2  S.  .. .  3E  T  (  51- F+G  *C)  .  . 

-7 . 07  1  (  7£-  C  1 ,  7.C7107C-01; 

C-ICCE  EIGHT  ttIGE AVECTO E  MATRIX . M _ 

-7.  07  1066C-01  -7.071  C68D-01 
1.CCCCCCD+C0  0.0 

CCNTECL  EIGENV ECTCR  MATRIX . C*M.  . 

-7.C71066D-01  7.C7106 8D-01 

C-LCCE  CRT.  REG.  LEFT  S-VECTOS  MATRIX. . M-INV .  . 

0.0  1  .000CC0D+00 

-1.41  iiZXUC-tCQ  -1  .QQQCCCD+OO 

IHE  CiTIKAI  FEE  CB  AC  if  GAIN  CCNTECL  MATRIX. .. C=BINV*GT*S. 
-1.0CCQI+0G  -1.41421+00 

THE  CLOSED  LCOP  DYNAMICS  MATRIX . F-G*C. . 

0.0  1.000CCCD+00 

-1.0CCCCCD+C0  -1  .4142140+00 

ANAIYSIS  COMPLETE.  EO  YOU  WANT  ANOTHER  SUN? 

TYPE  "YES"  OF  "SC", 

no 

. . .  ..OPTSYSX  IS  NOW  TERMINATED . 

F;  T*C. 54/2.84  15:  36:49 
xeccxd  off 

END  RECORDING  OF  TERMINAL  SESSION 
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E.  E1AME1E  OF  PBOGBAE  FAIL  DEE 


lie  following  cathc logical  example  cz  pzcqzaz  r?  .-.iur  - 
during  regulator  synthesis  was  taken  :*cs  the  Jou:;ai  o: 
Guicancs  and  Central,  Vci.3,  fie. 2,  pp. 190-192,  inarch- April 
1980. 

Ic  this  example,  the  choice  of  the  quadratic  index  value 
was  the  factor  promoting  program  instability;  leading  tc 
eventual  program  failure  in  subroutine  HQa2.  The  calculated 
regulator  cains  cf  -5.1,  and  -3.1  (pa.  63)  are  not  correct! 

With  a  'slight'  modification  of  the  cost  matrix  from  a 
previous  value  cf  a. 0000  to  a  new  value  of  4.0001,  the 
program  was  run  a  second  time.  Failure  did  net  occur  cn  the 
second  run,  anc  the  new  calculations  (pa.  68)  indicate 
filter  gains  of  -2.0,  and  a  "small"  residue  of  3.19D-14 
(essentially  zero).  These  are  the  corract  values. 

This  example  points  cut  one  possible  method  cf 
correcting  certain  pregram  failure  modes,  should  they  occur 
during  execution. 

The  full  terminal  session  is  recorded  below,  with  user 
input  in  lower  gase  letters  following  each  "?"  . 

Following  the  program  failure  example,  that  portion  cf 
the  repeated  terminal  output  was  delated  up  to  the  point 
where  program  execution  of  the  second  run  begins. 

record  cn 

E2GIK  EECCFEING  CF  T E E FINAL  SESSION 

B;  T® 0. 01/0.02  2  1;  49 ;30 

filedef  C6  term  (reefn  fa  blksize  133 

global  txtlib  fortmoc2  mcd2eeh  imsldp  ncnimsl 

lead  cptsysx  (start 

EXECUTION  BEGINS.. . 

OFTSTSX  IS  A  COMPLETELY  INTERACTIVE  OPTIMAL  SYSTEMS  CCETECL 

PBOGEAM.  IT  BILL  SOLVE  NUMEROUS  CONTROL  PROBLEMS  ON  TEE 
FOLLOWING  TYPES  OF  SYSTEMS  CONTROL  EQUATIONS; 


LSsrrt* .  n  Vi 
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XDOT 


=  (F)*X  *  <G)*U  +  (GAM) *  (W  +  WO) 

MEASCREMEN  1  EQUATION  — 

S  =  (H)*X  (D)  *W  +  V 

EEGULATG3  P ERFCRMANCE  IN D£X— - 
J  =  1/2  *  INTEGRAL  (X  *  (A)  *Y  ♦  0  ^  { E )  **  U )  £  1 
STATE  FEEDBACK  GAIN  DEFINITION— 

U  *  - (C)  *x 

DO  YOU  WISH  TO  CONTINUE?  TYPE  "YES"  OP  "SC". 


ALTHOUGH  OPTSYSX  IS  SPECIFICALLY  DESIGNED  TO  READ 
All  MATRIX  DATA  INTERACTIVELY,  SEVERAL  ALTERNATE 
KI1ECES  ARE  AVAILABLE  TO  OSERS: 

METHOD  1--THE  "F","G",  AND  "GAMMA"  MATRICES 
MAY  BE  BEAD  FR  CM  SEPARATE  DATA  FILES. 

METHOD  2— THE  "F'V'G",  AND  "GAMMA"  MATRICES  MAY  EE 
EXPLICITLY  DEFINED  ilTHIH  SUBROUTINE  "SETUE". 
(NCTE:  IN  EITEER  CASE,  THE  USER  SHOULD  03TAIN  A  COPY 
OF  THE  PROGRAM  LISTING  AND  EXAMINE 
THE  EXAMPLES  CONTAINED  IN  S/R  "  SETUF". ) 

EC  YOU  WISH  IC  CONTINUE?  TYPE  "YES"  C R  "NO". 


yss 

CO  YOU  WISH  TO  INPUT  THE  "F" ,  "G",  AND  "GAMMA" 
MATRICES  F PCM  SUBROUTINE  "SETUP"  IAW  THE 
METHOD  DESCRIBED  CN  THE  PREVIOUS  SCREEN? 

TYPE  "YES"  OB  "NO", 

no 

GENERAL  OPISYSX  OPTIONS; 

OPTION  1  —  SYSTEM  ANALYSIS  WITHOUT 

CPEN-LOCF  EIGENSYSTIM  CALCUL ATIONS. 
CET ION  2  —  SYSTEM  ANALYSIS  WITH  OPEN-LOOP 
EIGENSY STE M  C ALCULATIONS. 

OPTION  3  —  CPEN-LO CP  EIGENSYSTEM  FOUND 
AND  PROGRAM  TERMINATES. 

(«F"-MATRIX  ENTRY  FOLLOWS  IMMEDIATELY.) 
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OPTION  4 


7 


—  ECCAL  DISTRIBUTION  MATRICES  COMPUTED 
WITHOUT  FILTER  OE  REGULATOR  - :  T 
CF  STEA  C Y-ST  ATS  ANALYSIS. 
siuECi  a ii  0?  i iu  1\ :  5  0  3 ,  0  a  4. 


yes 


y 

1 


CO 


CO 


EC  YCC  DESIEE  Etc  VALUES  CF  STATE  AND  CONTROL? 

TYPE  '’YES*'  CR  "NO". 

CPISYSX  LQB/CLASSICAL  OPTIONS: 

OPTION  1  —  OPTIMAL  FILTER  i NE/OE  REGULATOR 

SYNTHESIS  WITH  NO  EXTERNAL  "C"  OE  "K" 
MATRIX  INPUT. 

CETION  2  —  OPTIMAL  FILTER  AND/OB  REGULATOR 
SYNTHESIS  WITH  EXTERNAL  "C" 

MATRIX  INPUT. 

OPTION  3  —  OPTIMAL  FILTER  ANE/OR  BEGULATOE 
SYNTHESIS  KITH  EXTERNAL  "K" 

MATRIX  INPUT. 

OPTION  4  ~  OPTIMAL  FILTER  AND/OR  REGULATOR 

SYNTHESIS  WITH  EXTERNAL  "C"  ANC  "K" 
MATRIX  INPUT. 

SELECT  AN  CETION:  1f  2,  3,  OR  4. 


LO  YOU  WISH  TO  IFTERMI N E  THE  STEADY-STATE  RESPONSE 
FOB  A  CONSTANT  DISTORFANCE? 

TYPE  "YES"  CE  "NO". 

£C  YOU  WISH  TO  EETERMI NE  THE  MODAL  DISTRIBUTION 
ANC  GAIN  MATRICES? 

TYPE  "YES"  CR  "NO". 

• 

CEEN-ICOP  TRANSFER  FUNCTION  OPTIONS: 

CPTICN  1  --  NO  CPEN-LCCP  TRANSFER  FUNCTIONS  COMPUTED. 
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CETICN  2 
CETICN  3 
CPTICK  4 


P0IES,  RESIDUES,  AND  ZEROS  COMPUTE: 
ON  1 1  POLES  AND  ZEROS  COMPUTED. 

ONLY  POLES  AND  RESIDUES  COMPUTED. 


SELECT  AN  CPTION:  1,  2,  3,  OR  4. 

2 

4 

NOISE  TRANS  EER  FUNCTION  OPTIONS: 

OPTION  1  --  NO  NOISE  TRANSFER  FUNCTIONS  COMPUTED. 
OPTION  2  —  POLES  ,  RESIDUES,  AND  iZRGS  COi'jeUIED. 
OPTION  3  --  ONLY  POLES  AND  ZEROS  COMPUTED. 

OPTION  4  —  ONLY  POLES  AND  RESIDUES  COMPUTED. 
SELECT  AN  CETICN:  1,  2,  3,  03  4. 

2 

1 

COMPENSATOR  TRANSFER  FUNCTION  OPTIONS: 

OPTION  1  --  NC  COMP.  TEANSFER  FUNCTIONS  COMPUTED. 
OPTION  2  —  POLES,  RESIDUES,  AND  ZEROS  COMPUTED. 
OPTION  3  —  CSII  POLES  AND  ZEROS  COMPUTED. 

OPTION  4  —  ONLY  POLES  AND  RESIDUES  COMPUTED. 

(NOTE:  A  COMPENSATOR  TRANS  EER  FUNCTION  CAN  EE 
COMPUTED  ONLY  IF  BOTH  A  REGULATOR 
AND  FILTER  ABE  SYNTHESIZED 
AND/OR  INPUT.) 

SELECT  AN  OPTION:  1,  2,  3,  OR  4. 

2 

1 

WILL  A  FEED-FOR  SARD  DISTRIBUTION  MATRIX 
("D"  -  MATRIX)  EE  INPUT  ? 

TYPE  "YES"  OR  "NO". 

10 

£0  YOU  DESIRE  TO  SYNTHESIZE  A  STABLE  FILTER  (OR  REGULATOR) 
3Y  DESTABILIZING  THE  ORIGINAL  SYSTEM? 

(NCTEjHORKS  for  filter  or  regulator  but  not  for  ecth 

IN  THE  SICE  RUN.) 
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1  YPE  "YES"  CE  "NO". 

rc 

DO  YGC  DESIEE  IC  PRINT  THE  EULER**LAGEANGE  SIG  2 1 S  YS II L 
PRICE  TO  DECCMEOSIT  ICN  {FOE  CHECKING  THE  PROGRAM)? 

TYPE  "YES"  CE  “NO1'. 

r.c 

PCKER  SPECTRAL  DENSITY  (FSD)  OPTION  1  : 

CFTICR  1  —  COMPUTE  TEE  PSD  Or  THE  OUTPUTS  AND/OR  THE 

CONTROLS  CF  THE  CONTROLLED  SYSTEM  WHEN  FORCED  BY 
PROCESS  AND  MEASUREMENT  NOISE.  (NOTE:  ECTH  A 
REGULATOR  AND  A  FILTER  MUST  BE  RESIDENT  IN  THE 
PROG  RAM  TC  USE  THIS  OPTION.) 

OPTICS  2  —  SAME  AS  CETION  1  AEOVE  BUT  ONLY  PRINT  THE 
RESIDUES  CE  EACH  TRANSFER  FUNCTION 
USED  IN  TEE  PSD  COMPUTATION. 

OPTION  3  —  NOT  DESIRED. 

SELECT  AN  CETION:  1,  2,  OR  3. 


DC  ICC  DESIRE  REGULATOR  SYNTHESIS  ONLY? 

TYPE  "YES"  OR  "NO". 

yes 

INTER  THE  #  OF  STAIES  (NS)  OF  THE  SYSTEM  MATRIX 
<"F"-K ATRIX)  . 

? 

2 

ENTER  THE  *  OF  CONTROLS  (NC)  OF  THE  SYSTEM  MODEL 
("G"-M  ATRIX)  . 

? 

1 

ENTER  THE  #  OF  MEASUREMENTS  OR  OBSERVATIONS  (NO) 
("H"-M  ATRIX) . 

t 

2 

ENTER  THE  *  OP  PROCESS  NOISE  SOURCES  (NG) 
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("G  AtiM  A "-M  A1BI X ) 


t 

C 

EIAG/FAEAMETEB  SETTINGS  FOB  THIS  RUN  ABE  AS  FCLIC-S: 

IOL  IC  IE  ISS  Id  ITF1  ITE2  ITF3  IF  DEW  IE  IEZEUG 
11C001  0  0  0  00 

JSEI  IDSTAE  IP  SD  IYU  I N  CEK  IREG  NS  NC  NOB  NG 
0  C  OC  C  12120 

CEDES  CE  S YSTEM  =  2 

NOME  EE  Cf  CONTROLS  =  1 

NUSEEB  CF  OBSERVATIONS  =  2 

NOMEIE  CF  EROCESS  NCISE  SOURCES  =  0 

ENTER  THE  SYSTEM  MATRIX  («F "“MATRIX) 

DIMENSION  *  #  STATES  (NS)  X  #  STATES  (NS) 

THE  ELEMENT  F(  1,  1)  * 

1 

C 

TEE  ELEMENT  F(  1,  2)  * 

I 

1 

THE  ELEMENT  F (  2,  1)= 

? 

-1 

TEE  ELEMENT  F(  2,  2)  = 

? 

0 

THE  SYSTEM  MATRIX  ("F"-M ATRIX)  ..  . 

0.0  1.0CC00 

-1.CCOOC  0.0 

DO  YCO  WISH  TO  CHANGE  THE  VALUE  OF  ANY  MATRIX  EIEHENT? 
TYRE  "YES"  CB  "NO", 
nc 
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CEEN  1CCF  DYNAMICS  MATRIX . . 

O.C  C.100CI+01 

-o.  icccr+o  i  o.o 

CEEN  1CCP  EIGENVAIOES . LST(SI-F).. 

0.0  ,  1.C000CI  +  00: 

CEEN  ICC?  SIGHT  EIGEiiVECTCF  MATRIX . I _ 

0.0  -  1  .000CCCD+00 

1.CCCCCCD+C0  0.0 

CEEN  LCC2  LEFT  EIGENVECTOR  MATRIX . T-INV.. 

0.0  1.000CCCD+00 

-1. 00C0CCE+C0  0.0 

ENTER  THE  MEASUREMENT  SCAIING  MATRIX  ATR IX)  . 

DIMENSION  *  #  OBSERVATIONS  (NO)  X  #  STATES  (KS) 
THE  ELEMENT  H<  1,  1)  = 

7 

C 

TEE  ELEMENT  H(  1,  2)  - 

1 

0 

THE  ELEMENT  H (  2,  1)= 

7 

C 

TEE  ELEMENT  H(  2,  2) - 

? 

-1 

TEE  MEASUREMENT  SCALING  MATRIX  ("H"-MATRIX) . . . 

0.0  0.0 
C.O  -1.0CC00 

EC  ECU  WISH  TO  CHANGE  THE  VALUE  OF  ANY  MATRIX  ELEMENT? 
TYPE  "YES"  CR  "NO", 
no 
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MEAStEEEENT  SC  A  LI  KG  MAT  FIX . H.  . 

0.0  0.0 

0.C  -0.100CC+01 

MCEAL  MEASUREMENT  SCALING  MA1RI X.  .  .  A  (3  AS)  *T.  . 

C.O  O.C 

-I.CCCOOOD+OO  O.C 

ENTER  THE  OUTPUT  MEASUREMENT  COST  MATRIX  (" A"-MATRIX)  . 
Cl  MENS  ION  *  #  0  ESERVAT  IONS  (NO)  X  «  OBSERVATIONS  (NO) 

1  fir  ELEMENT  A(  1,  1)  = 

? 

C 

TEE  ELEMENT  A(  1,2)* 

% 

0 

THE  ELEMENT  A(  2,  1)* 

% 

C 

TEE  ELEMENT  A(  2,  2)* 

7 

4  ' 

THE  OUTPUT  MEASUREMENT  COST  MATRIX  (" A"-MATRIX) . . . 

C.O  0.0 

C.O  4.0CC00 

CC  YCU  WISH  TO  CHANGE  THE  VALUE  OF  ANY  MATRIX  ELEMENT? 
TYPE  "YES"  CR  "NO", 
no 

CCIPCT  COST  MATRIX . . . A.. 

0.0  0.0 

0.0  0.400GE+01 

INTER  THE  CCNTPCL  DISTRIBUTION  MATRIX  ("G"-MATRIX)  . 

DIMENSION  *  #  STATES  (NS)  X  #  CONTROLS  (NC) 

TEE  ELEMENT  G(  1,  1)* 

7 
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TE  Z  ELEMENT  G(  2,  1)  = 

* 

i 

THE  CCNTROI  DISTRIBUTION  MATRIX  ("G"-HATRIX)  . 

c.o 

I.CCflOC 

CC  YCU  KISH  TO  CHANGE  THE  VALUE  0?  ANY  MATRIX  ELEMENT 
TYPE  "YES"  CB  "NO", 
no 

ENIEB  THE  CCNTRCI  COST  WEIGHTING  MATRIX  ("B"-M ATRI X) 

C IMENS ION  *  #  CONTROLS  (NC)  X  #  CONTROLS  (NC) 

THE  ELEMENT  B(  1,  1)* 

? 

1 

TEE  CONTROL  COST  MATFIX . B... 

1.CG00C 

LC  YCU  WISH  TO  CHANGE  IKE  VALUE  OF  ANY  MATRIX  ELEMENT 
TYPE  "YES"  CE  "NO", 
no 

TEE  CONTROL  DISTRIBUTION  MATRIX . ...G.. 

0.0 

0. 1CC0C+01 

MCLAI  CONTROL  DISTRIBUTION  MAIRIX . TI*G.. 

1  .CCC0CCD+00 

0.0 

THE  CCNIROL  COST  EATRIX . B.  . 

0. 10C0I+O  1 

CEEN  LOCP  TRINSFEE  FUNCTIONS... 

TF  ECE  INPUT  NO.  1  AND  OUTPUT  NO.  1: 

NC  FINITE  ZEBOS.  TF  GAIN  »  0.0 


RESIDUES  AT  THE  POLES: 

POLES  RESIDUES 

REAL  (A)  IMAG(E) 

<  0.0  )+J<  I.OCOOOC)  (  0.0  )  EX?  (A*T)  *C0S(3*T) 

(  O.C  )  *0  (-1  .  OCOOOC)  (  0.0  )  EXP  (A*T)  *SIN  (E*T) 

IF  ECU  IKPCI  NO.  1  AND  CUT  EOT  NO.  2: 

CEDES  C£  KUiiERATCR  =  1  IF  GAIN  =  -C.1000D+01 

NUMERATOR  EIGENVALCES  (INCLUDING  EXTRANEOUS  ZERO  VALUES) 

(  0.0  )  +J  (  0.0  ) 

(  0.0  )+J<  0.0  ) 

RESIDUES  AT  THE  POIES: 

ECLES  RESIDUES 

REAL  (A)  IMAG  (B) 

(  0.0  )+J(  1.000000)  (  -1.C00000)  EXP  (A*T)  *COS  (E*T) 

(  O.C  )  +  J  (-1.000000)  (  0.0  )  EXP  (A*I)  *SIN  (E*T) 

FAILURE  IN  HQ £2  OS  EIGENVALUE  NO.  4 

-1.  96  2366D+C0  3. 464612D-03  -2.4S9867D+00  1 .5086570+00  ' 

3.4  6  U838D-03  3.762  172D-02  -1 .49 1 143  0+00  2.500102C+00 

-4.4  15Q41E-15  -3.20  8 643D- 1 3  -  1 . 96 2366D+ 00  3.621  151D-03 

5.28  1S45D-  11  -1  .267812D-17  3.621125D-03  3.  762121D-02 

E 3G EKSY STEM  CF  OPTIMAL  REGULATOR . 

EULER- LAGRANGE  EQUATIONS  HAVE  A  REAL  EIGENVALUE 
AT  OR  NEAF  ZERO. 

C-1CCP  OPTIMAL  REG.  E-V  ALU  E  S.  . .  DET  (SI-  F+G*C)  .  . 

0.0  :  0.0  ,- 1. OOOOCD+OO: 

C-LCCP  BIGHT  EIGENVECTOR  MATRIX . M.  .  .  . 

-7.C588C7D-C1  6.035 165D-01 

-7. 0  833C7C-01  1  .000CCCD+00 
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CCSTFCL  EIGENVECTOR  SAT  Eli . C*H.  . 

-  1.4  1176  ID*  00  -1  .  5C4737D-02 

C-LCCF  CFT.  BEG.  1111  2-V'xCICv.  MATRIX.  .  S-Ili7 .  . 

-3. 592C62D+C0  2.1676S8D+00 

-2.  544382D-K30  2.535562D+00 

THE  CF1IMAI  FEEDBACK  GAIN  CONTROL  MATRIX. . .C»3INV*G1*S  .. . 


5.  1CS5E+0C  -3.0987C  +  Q0 

TEE  CCD AL  CONTROL  GAINS . C*T.  . 

-3.CS66S6D+00  -5.  1C9451D +CQ 

TEE  CICSED  LCO F  DYNAMICS  MATRIX . F-G*C. . 

0.0  1  .000  CCCD+00 

4. 10S451D+C0  -3 .0986S6D+0Q 


ANALYSIS  COMPLETE.  EO  YOU  WANT  ANOTHER  RUN? 

TYPE  "YES"  OS  "NO". 

yes 

EC  YOU  WISH  TO  SAVE  THE  "f "-MATRIX  FROM  THE  LAST 
EON  TO  BE  USED  IN  THE  FOLIOWING  RUN? 

NOTE:  THE  MATRIX  WILL  EE  REDISPLAYED  AT 
TEE  PECFER  INPUT  SEQUENCE  INTERVAL 
AND  YOU  WILL  HAVE  THE  CFTION  OF  CHANGING 
INDIVIDUAL  MATRIX  ELEMENTS. 

TYPE  "YES"  OB  "NO". 

yes 

CO  YOU  WISH  TO  SAVE  THE  "H"-MATRIX  FROM  THE  LAST 
SUN  TO  EE  USED  IN  THE  FOLLOWING  RUN? 

NOTE:  IHS  MATRIX  WILL  EE  REDISPLAYED  AT 
T£E  FBCPER  INPUT  SEQUENCE  INTERVAL 
AND  YOU  WILL  HAVE  THE  CFTION  OF  CHANGING 
INDIVIDUAL  MATRII  ELEMENTS. 

TYPE  "YES"  OS  "NO". 

yes 

CC  YOO  WISH  TO  SAVE  THE  "G"-MATRIX  FROM  THE  LAST 
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BUN  1C  BE  USED  IB  THE  BCLICWING  RUN? 

seif:  i he  narais  will  be  pedispl ayid  at 

THE  FBCPEF.  INPUT  SEQUENCE  INTERVAL 

ate  YCU  WILL  HAVf  THE  OPTION  0?  CHANGING 

INEIVIEUAL  If  AT  BIX  ELEMENTS. 

TYPE  "YES"  OS  "NO". 


Author's  rote:  Since  the  same  program  options  are  to 

be  run  again,  with  only  a  change  in  ore 
of  the  cost  matrix  element  values,  the 
terminal  output  was  deleted  up  to  the 
point  where  program  calculations  resume 
in  order  tc  avoid  redundancy. 

OBEEB  01  SYSTEM  =  2 

NUMBER  CF  CONTROLS  =  1 

NUME1S  CF  OBSERVATIONS  =  2 

NUMBER  CF  EROCESS  NCISE  SOURCES  =  0 

THE  SYSTEM  MATRIX  ("F"-MATRIX>  . . . 


1.00000 


-1.CC0CC 


IC  YCU  WISH  TO  CHANGE  THE  VALUE  OF  ANY  MATRIX  ELEMENT? 
TYPE  "YES"  CB  "NO". 


OPEN  LCCF  DYNAMICS  MATRIX . F. 


-0. 1CC0E+Q1 


0.100CC+01 

0.0 


CEEN  LOOP  EIGENVALUES . DET(SI-F). 

)  ~  ,  1  .  C0  00CE+00; 


CEEN  LCCF  RIGHT  EIGENVECTOR  MATRIX . T. 

0.0  -1 .OOOCCOD+OO 

1.  0C00CCD+  CO  0.0 


.  •  V 


CPFS  ICCP  LEFT  EIGENVECTOR  MATRIX . T-INV. . 

0.0  1.0G0CGCD+G0 

-1.  OCOOCCD+CO  0.0 

IRE  MEASUREMENT  SCALING  MATRIX  ( "H"-MATRIX) . . . 

C.O  0.0 

C.G  -1.0CC00 

£C  YCU  WISH  TO  CEANGE  THE  VALUE  OF  ANY  MATRIX  ELEMENT? 
TYPE  "YES"  CR  "NO", 
r.o 

MEASCSE  KENT  SCALING  MATRIX . H.  . 

0.0  0.0 

O.C  -0.100CE+01 

KCIA1  MEASUREMENT  SCALING  MATRIX.  ..  H  (BAR)  *T.  . 

C.O  O.C 

-I.OCOOOOD+OO  O.C 

ENTER  THE  OUTPUT  MEASUREMENT  COST  MATRIX  ("A" -MATRIX) . 
IIMESSION  «  #  OBSERVATIONS  (NO)  X  *  OBSERVATIONS  (NO) 
TEE  ELEMENT  A{  1,  1)* 

? 

C 

TEE  ELEMENT  A(  1,2)* 

•5 

• 

0 

THE  ELEMENT  A(  2,  1)  = 

i 

c 

TEE  ELEMENT  A(  2,  2)* 

1 

4.0001 

THE  CUIFUT  ME  AS  EBEMENT  CCSI  MATRIX  ("  A"-MATRIX)  •  .  . 

C.O  0.0 

C.O  4.0CC10 

£0  YOU  WISH  TO  CHANGE  THE  VALUE  OF  ANY  MATRIX  ELEMENT? 


TYPE  "YES”  CS  "NO" 


r.c 

CUIECT  COST  MATRIX . A.. 

O.C  0.0 

O.C  0 .40  OCL  +  Q  1 

TEE  CONTROL  DISTRIBUTION  MATRIX  {"G"-M ATBIX)  .  . . 

c.o 

1. ccooc 

DC  YOU  WISH  TO  CHANGE  THE  VALUE  OF  ANY  MATRIX  ELEMENT? 
TYPE  "YES"  CR  "NO", 
no 

EPIEE  THE  CCNTBCI  COST  WEIGHTING  MATRIX  ("B"-M  ATRI X) 
DIMENSION  =  #  CON  TP.OIS  (NC)  X  #  CONTROLS  (NC) 

THE  ELEMENT  B  (  1,  1)  * 

■j 

1 

TEE  CONTROL  COST  MATRIX . B... 

1-  ccooc 

IC  YOU  WISH  TO  CHANGE  IHE  VALUE  OF  ANY  MATRIX  El E MEN I? 
TYPE  "YES"  CE  "NO", 
no 

TEE  CONTROL  DISTEIBUTION  MATRIX . G.  . 

0.  C 

0.1 C  COE  +  O  1 

KCIAL  CONTROL  DISTRIBUTION  MATRIX . TI*G.  . 

I.CCCOCCD+OO 

0.0 

THE  CONTROL  COST  EATRIX . B.  . 

0.  1CC0D+01 

OPEN  LOOP  TRANSFER  FUNCTIONS... 

TF  EOF  IEEOT  NO.  1  AND  OUTEUT  NO.  1: 

PC  FINITE  ZEFOS.  TF  GAIN  *  0.0 
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RESIDUES  AT  THE  POLES: 


F  C  L 


EES 


0  E  S 


REAL  (k)  125  AG  (  B) 

(  O.C  )+J(  1.0000CC)  (  0.0  )  EX?  (A*T)*COS  (E*T) 

(  O.C  )+J  <  -1.COOOCC)  {  0.0  )  EXP(A*T)*SIN  }5*T) 

IF  FCF  INPUT  NO.  1  A NE  OUTPUT  NO.  2: 


OREEE  CF  NUMERATOR  =  1 


TF  GAIN  =  -0. lOOOC+OI 


NUHEF.ATCB  EIGENVALUES  (INCLUtING  EXTRANEOUS  ZERO  VALUES): 
(  O.C  )+J(  0.0  ) 

(  O.C  )+J(  0.0  ) 


RESILUES  AT  THE  POLES: 
POLES 

BEAL  (A)  IM  AG  (E) 

(  O.C  )+J(  1.COQOCO) 

(  0.0  )*J  (  -1.  COOOCC) 


RESIDUES 

(-1.000000)  EXP<A*T)  *COS  (B*T) 
(  0.0  )  EX?  (A*T)  *SIK  (B*T) 


EIGENSX STEM  CF  OPTIMAL  EEGDLATOR. 


C-LCCE  OPTIMAL  REG.  E-VALUES...DET  (SI-F+G*C) 
-1.005C1t  +  0C:-9.95012C-01: 


C-ICCE  FIGHT  EIGE5VECTO E  MATRIX, 
7. Q53368E-01  -7 .0 88723D-01 
-7.066723D-C1  7  .053368D-01 


CCSTECL  EIGENVECTOR  MATRIX . C*M.  . 

1.4  177 6 2D* 00  -1 .410691D+00 

C-LCCE  OPT .  REG.  LEFT  E-VECIOR  MATRIX.  . M- INV, 
-1.41C6S1D+C2  -1  .4 17762D+02 
-1.  4  17762t*C2  -  1  .4  10 € S  1D+0 2 
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THE  OPTICAL  FEZIEACK  GAIK  CCKIHO L  MATRIX.  .  ,C=3I 
-3.1S74E-14  -2  .00  QCE  +  00 

I  EE  i'CC  AL  CONTROL  GAIKS . C*T. 

-2  .CCCC25D*  0  0  3.1S7442D-14 

TEE  CLOSED  LOOP  CYNAMICS  MATRIX . F-G*C. 

0.0  I.OOOCCOD+OO 

-I.OCtOuCE^CO  -2.000C25D+GG 

ANALYSIS  COMPLETE.  CO  YOU  V  A  ST  ANOTHER  RUN? 
TYPE  ‘'YES"  OR  "SC". 

EC 

. CPTSYSX  IS  NOh  TERMINATED . 

E;  T*C-€3/2.60  23:33  :C7 

record  off 

END  RECCEDI NG  OF  TERMINAL  SESSION 
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V.  C^^CICSTCIiS  AN  t  RECOMMENDATIONS 

1.  CCNCIUSIGNS 

Although  origirally  developed  for  the  quadratic 
synthesis  cf  controllers  for  rotary-wing  VIOL  aircraft,  the 
extensive  rncdif icaticns  and  enhancements  of  Hall's  original 
work,  coupled  kith  its  efficient  and  accurate  eigersystsm 
solution  routine,  represent  a  powerful  tool  in  the  design  of 
optimally  controlled  systems. 

In  its  present  interactive  fora,  CPTSYSX  has  been  trans¬ 
ferred  fro®  the  arena  of  high-level  applied  mathematics  and 
numerical  analysis  to  the  level  cf  control  system  engineers 
and  students.  It  now  represents  an  even  more  powerful 
educational  tool,  able  to  rapidly  and  effectively  unlock 
iiany  nisundarstcod  linear  systems  mathematical  relation¬ 
ships  . 

As  at  ultimate  evaluation  cf  the  computational  abilities 
cf  OETSYSX,  the  program  was  tested  using  an  82  X  82  matrix 
cf  aircraft  longitudinal  motion  equations  for  the  vx-29 
experimental  Fighter  aircraft  derivative,  provided  by 
NAS A-Ecwer ds. 

Per  a  system  of  eguations  of  this  magnitude,  all  program 
arrays  were  re-dimensioned  (as  shown  in  Appendix  A)  ,  and  a 
2-Megabyte  virtual  machine  size  was  required.  This  system 
was  run  through  the  Medal  Analysis  option  of  CPTSYSX, 
requiring  less  than  90  seconds  to  load  the  system  and 
complete  all  open-lccp  and  modal  analysis  calculations! 

Erograa  results  exhibited  perfect  eigenvalue  correlation 
with  these  cbtained  from  the  John  Edwards  Control  Pregram. 
Additionally,  OPTSYSX  provided  complete  longitudinal  modal 
analysis,  previously  unavailable  cn  a  system  cf  this  size. 
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It  is  hoped  that  the  css  cf  this  interact!  vs  ;. 
version  hill  be  encouraged;  and  that  its  expanded  a i_idn ies 
vill  stimulate  tcth  interestir.  and  research  or  b  -  sic  sjr.-'" 

ccQtrcl  problems,  as  hell  as  acre  advanced  designs. 

£.  SICCKHODATICHS 

Based  cr.  the  results  of  this  thesis,  four  areas  emerged 
as  possibilities  for  further  research  and  study: 

1 .  Program  Availabili  II 

The  use  of  CETSYSX  and  similar  design  programs 
should  be  encouraged  in  all  undergraduate  and  graduate  level 
courses  involved  in  the  analysis  and  design  of  control 
systems.  Toward  this  end,  it  is  recommended  that  OPTSYSX  be 
placed  it  the  ncn-I£SL  library  of  subroutines,  makirg  it 
easily  available  to  all  potential  users. 

2 .  Computer  Graphics 

Its  addition  cf  graphical  plotting  routines  tc  the 
program  in  the  time  and  frequency  domain  would  make  CFISYSX 
an  even  more  powerful  tool  in  the  design  of  many  optimally 
controlled  systems. 

3-  Further  Hodi f icatlons 

The  present  version  cf  the  program  should  te  modi¬ 
fied  to  include  the  CETSYS  5  derivative  input  term  improve¬ 
ments  cf  liu  [fief.  3],  and  program  sequencing  during  optimal 
filter  synthesis  should  be  examined.  Various  test  runs 
indicate  an  area  of  conflict  in  that  the  program  appears  to 
require  the  design  of  an  optimal  regulator  prior  to 
performing  any  filter  calculations. 
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APPENDIX  A 

OFTSYEX  PROGRAM  LISTING 


c** 

c** 

c** 

c** 

c** 

c** 

c** 

c** 

C++ 
C  +  + 
C++ 
C  +  + 
C+  + 
C++ 
C++ 


***  « ** 
****** 

****** 

****** 

****** 

****** 

****** 

****** 

***  *  ** 

****** 

***•****•**•****•***•***•••*•*»*••••• ********************** 
**•*••••  **** 

•  * 


****** 

*••• 

**** 

*  ••* 
*** 


OPTSTSX 

HT  JOHN  G.  HCCEN 

THIS  PRCG3AM  IS  A  COMPIETELY  I  NT  EB  ACT  IV  S 
OPTIMAL  SYSTERS  CONTSCI  DESTGN/3YN THESIS 
PRCGBAM  CAPABLE  0?  HASHING  VEST  LARGE  (80X30)  ♦ 
MCLTI V  A  PI ABLE  SYSTEMS  CP  LINEAR  EQUATIONS. 


*******  • 


V  ESSICN  i.a 


11  MAE  1984 


c— - 


IMPLICIT  BEAL*8  ( A— H , C-Z) 


INTEGEB  IANS , ICL , IQ  ,  IB, ISS, IM  ,  ITP 1 . 1  TP  2 , ITF3 , 1 ?DFW , IE , IDE30G . IS  ST , 
1IPSD.I  YU.INOHM  ,SS,BC ,NOB  ,  SG  .1  BEG ,  IDST  AE .  IBET  ,  S  BOH  ,  NCOL  r  IS  A  F,  IS  AH,  I 
2SAG.IGAM 


LABGE  QBCEB  SYSTER  (£2  X  62)  CIHENSICNS. 


*  JCF 
•GV  ( 


LAD  10  4)  ,  A  A  I  C  4  «  C  41  ,  Dn  104,  *  I  )  ,1-0  l*  I  ,04)  ,  u  l'.  (  ,  <  I  )  ,  J  o  *U  nc.  104  ,04) 

(16  4)  ,BES  (164)  ,AY  (82,8  2)  ,  BE  (164)  ,  CC  (164)  ,  CP  (3  2)  ,GW{  164,4  1)  , 
164  ,4  1)  ,HY  (4  1,  16«)  ,a5  <41 , 164)  ,PBTT  (16,  16)  ,DUN  (82,85) 


STANDASD  PROGRAM  CIRENSIONS. 


C— 

c— 

c— 

c— 

c 

c 

c— 


to 


V 

4 

5.  - 
6(3 
7) 


Ncsn(32,32)  ,  WNCFSI(32,32)  ,DESTAB<32)  tAA(32,)2)  ,3(1 
.0(32,35)  ,D§TCBE  <32 ,32)  ,JCF  (64),2eS  (64)  .AY  (32,  52) 
(32)  ,G3  (64,64)  ,GV  (6  4,64)  ,  HY  (6  4 ,64)  ,  i}  U  (6  4 , 64)  ,  P  RTT 


,33  (64}  'cc  (64)  , CP 


(16,1b)  ;DOM(32',32 

EQUIVALENCE  (W  1  1(1,  1)  ,GS  <1,  1)  )  ,  (H11  (1,  1)  ,GV  (1  ,1)  )  (H  2*t  (  1  ~1)  ,HY  (1 

_ (M3H1.1)  ,dO(1,1)  ) _ 

COMMON  /PROG/  IOL  .  IC  ,  IB  ,  ISS  ,  I R  ,ITP1 ,  ITP 2 , IT? 3 , IFDFV , IE , IDS T AE , I C EB 
10G,ISET, IBEG.IPSEH J£,INOEM 

DATA  1 1/  *  Y*  /  ,  I Z/  *  K '/ __ 

SUPPRESS  INCIVIDDAI  Q  NO  EBP  LCD,  OVEFFLOH ,  CIVIDE  CHECK,  AND  DECIMAL  * 
CCHVEBT  2HBCB  MESSAGES;  PROVIDE  SUMMARY  OF  2HR0BS  ONLY.  * 

CALL  EHBSET  (  2 C7 ,256  ,- 1 , 1 , 2 C  9) 

CALL  ERBSET  (2  1  5  ,256^-1 , 1 ) 

INITIALIZE  FLAGS. 

ISAP»0 
ISAG=0 
ISAH-0 
IGAM=0 
CCBTINUE 
IBET*Q 
ICL-0 
IC*0 
18*0 
ISS-0 
IH«0 
ITF1*0 
II?2»0 
ITF3*0 
IFOPH*0 
IE*0 

IDSTAB*0 


72 


IEE30G-0 

IS£T*0 

IPSD30 

110*0 

isoaa*o 

IBEG*0 

N£*0 

NC*0 

NCB*0 

NG*0 


') 


30 

40 

C - 

SO 


60 
70 
c— - 

90 


90 
100 
c— - 


110 

120 

130 

C - 

C - 

140 

150 

160 


C - 

170 


CALL  PSTC3S  ( '  CX3SCSS 
48IXB  (5,890) 

CALI  BBCHAH  (IMIS) 

XI  (JIANS.NE.  IY)  .AND.  (IANS.NE.IZ)  )  GO  TC  30 
GC  TO  40 
WHITE  (5,389) 

GC  TO  20 
CONTINUE 

IF  (IA  NS.EQ.XZ)  GC  TC  560 

CALL  FHTC8S  ( '  CLBSC3  N  •) 

W8XTE  (5,900) 

CALL  RDCflAH  (IJN5) 

IF  ((IANS.ME.IY)  .ANC.  (IANS.  NE.IZ)  )  GC  TO  60 
GO  TO  70 
WHITE  (5,890) 

GO  TO  50 
CONTINUE 

IF  (IANS.EQ.IZ)  GC  TC  560 


-SCSS1  ■ 


-SCHN2- 


CALL  FSTC3S  ('CLBSCBN  ') 

WHITE  (5,910) 

CALL  BDCKAB  (IANS) 

If  ((IANS.NE.IY)  -AND.  (IANS.  NE.IZ)  )  GC  TC  90 
GC  TO  IOC 
WBIT2  (5,8801 
GO  TO  80 
CONTINUE 

IT  (IANS.EQ.IT)  ISET=1 

CALL  FBTCBS  (*C13SCBN  ') 

WHITE  (5,570) 

CALL  9DINT  (IANS) 

ICL-IANS-1 

IF  (I0L.EQ.2)  GO  TO  350 


- ISET - 


-IOL- 


CALL  F8TCES  ( ' CL3SCEN  <) 

WHITE  (5,580) 

CALL  B  DC  HAS  (IANS) 

IF  ((IANS.NE.il)  .AND.  (IANS.  NE.IZ) )  GO  TC 
GO  TO  13C 
WBITE  (5.880) 

GO  TO  110 
CONTINUE 

IF  (IANS.EQ.II)  IC»1 
IF  (IANS.EQ.IZ)  l{»0 
IF  (lOL.EQ.3)  GO  XO  200 


-IQ- 


120 


CALX_PBTCBS_ ( • CLBSCE  N 
ANS) 


WHITS^5j590^ 


- IB - 

’) 


CALL  a 
_IH*IANS- 1 

CALL  FBTCHS  ('CLBSCSB  •) 

WHITE  (5,600) 

CALL  B DC BAB  (IANS) 

II  (JIAN|.8E.II)  .ABC.  (IhHS.  NE.IZ)  )  GC  TO 
GC  TO  160 
WHITE  (5  ,880) 

GO  TO  140 

Si"THSi.EQ.  IT)  ISS*1 
IF  (IANS.EQ.IZ)  ISS«0 


150 


WHITE  (5,610) 


-ia- 


73 


on  nn 


180 

190 

200 


C - 

210 

220 

230 

C - 


c - 

290 

250 

260 

C - 

270 

280 

290 

300 
C - 


CALL  3  DC  BAR  (IANS) 

IF  (flAMS. HZ.  17)  .AND.  (IANS.  NS. 12)  )  GO  TC  180 
GO  TO  190 
BBITZ  <5,880) 

GO  TO  17C 
CONTINUE 

IF  (IAHS.BQ.I1)  Ifi-1 
IF  (I1NS.EQ.  IZ)  18=0 
CONTIHOZ 

IF  (IOL.EQ.3)  M=  1 


CALI.  F3TCHS  ('CLRSCS 
HHITE  (5,620) 

CALL  SalHT  (IANS) 

ITF1-I ANS-1 

IF  (IOL.EC.3)  GO  TO  240 


- ITF1-- 

) 


•ITF2- ■ 


CALL  FBTCSS  ('CLBSC8N  «) 
KBITS  (5,630) 

CALL  3DINT  (IANS) 
IIF2»IAB£-1 

IF  (I0L.IQ.3)  GO  TO  240 


CALL  FSTCBS  ('CLRSCSN 
KBITS  (5  ,640) 

CALL  8DINT  (IANS) 
ITF3»I ANS-1 


') 


- IFDFK- 


CALL  FHTC2S  ( ' CLRSCSN 
NRITE  (5,650) 

3DCBA2 


’) 


CALL 

GO 


IF  ( (I ANS.HE.IY) ?IhO 


(IANS) 

_ .11)  .AND.  (IANS.  NE.IZ))  GC  TC  22 0 

..  230 

KEITE  (5,880) 

GC  TO  210 
CONTINUE 

IF  (IANS. ZQ.  II)  IIDFK-1 
IF  (iANS.gQ.  IZ)  I?CFK=0 

cau'fetcbs  cciascEN  •) 

KBITZ  (5,660) 

CALL  HOrIal  (ANS3) 

IE*IDI  NT  (AHSH) 

IF  (IOL.EQ.3)  GO  TO  300 

CALL  FBTCBS  ('CLHSCBN  •) 

BBITZ  (5,670) 

CALL  30CHAB  (IANS) 

IF  l(IANS.HE.Il)  .AND.  (IANS. 

GC  TO  260 
BBITZ  (5  ,880) 

GO  TO  240 
CONTINUE 

IF  (IANS. IQ. II)  ICSTA8-1 
IF  (IANS.gQ. IZ)  ICSIA8-Q _ 

BBITZ  (S  ,680) 

CALL  B  DCHAfi  (IANS) 

IF  ^lANg.NB.II)  .AND.  (IANS. 

Ihl  lh690) 

CONTINUE 

IF  (IANS. IQ.  II)  ICIBUG*  1 
IF JlANS.EQ.  IZ)  IEIB0G»O 
CONTINUE  __  _  _ 

'  CLBSCBN  • 7”  ~  "'J 

i?  . 


- IDSTA3 

NE.IZ) )  GC  TC  250 

- 1  DEBUG 

NE.IZ) )  GC  TO  280 


ANS) 


CALL  B1 
IFSD-IANS 
IF  (IPSD.IQ.3)  IPSD-C 
IF  (IPSD.EQ.O)  GO  TO  310 

CALL* FBTCBS  (• CLRSCS N  > ) 
BBITZ  (5,700) 


- ITU - 


c 


CALL  S 01  NT  (II NS) 
IIU«IANS-1 


■I  SOBS 


310 

c - 


CALL  P BTCHS  ('CLBSCZN  ') 
MBITS  (5,820) 

CALL  3D8EAL  (  A  NS  3 ) 

ISCRa»  ID  1ST  J  A  H  S3) 

I?  (IOL.EC.J)  GC  TO  350 


320 

330 

340 


C - 

350 


CALL  P8TCSS  {'CI8SCSN  •) 

SHITS  (5,710) 

CALL  aOCHAO  (IANS) 

IP  ( (IANS.  ME.  IT)  .AND.  (IANS-  NE.  12)  )  GC  TC  330 
GO  TO  340 
MBITE  (5,880) 

GO  TO  320 
CONTINUE 

IP  (IANS. £Q.  IT)  IBEG*  1 
I T  (IANS. EQ. 12)  IS£G*0 


C - 


CALL  PHTCSS  ('CIBSCfid  • 
SHITE  (5,720) 

CALL  3DHZAL  (ANSH) 
NS»IDI NT JANSH) 

IP  (IOL.EC.2)  GO  TO  360 


NS- 


B  (5,730. 

CALL  B  OaEAL  ( A8SB) 
NC  =  IDI NT  (ANSH) 


C - 


SHITE  (5,740) 

CALL  BOREAL  (ANSH) 
NOB»IDINT (ANSB) 


- JIDB - 


-SG- 


HBITS  (5,750) 

CALL  H  DREAL  JANSa) 

NG-IDINT  (ANSH) 

360  _ CCNTIN  UE _  _  _ 

CALL  PHTCSS  ( ' CLHSCB  N  •)  ‘  ^ 

SHITS  (6,760) 

SHITS  (6  ,770) 

SHITE  J6  ,780)  IOL,IQ,IH,  ISS  ,  I  E.ITF1 ,  ITP2.ITP3,  IPOFS,  IE, IDEEDG , IS ET 
1  , IESTAB 


SHITE 

16,790) 

SHITS 

(6.800) 

IPSE, ITU, 

SHITE 

c - 

(6  ,810 

NS,  AC,  NOB 

C - 

370 


380 

390 


C — 
400 


410 

4  20 
430 


- - - BEGIN  CALCULATIONS - 

N2«2*SS 

CALL  INN  EH  (HS.NC.NCE.NG, N2,ACI,B,8A ,CI ,CH ,CQ, CSI ,CSB , D, PBGC, PEG E, 
1G.GAB,  G  >7  ,  Gtl ,  H  C  ,  D 1  ,D2  .PRO  .  HB.HC  ,  C  ,  SC.  S  B  ,  SI  ,  S 11 ,  S2  1  ,  X  .  5N  CHB  ,  S  NO  FM I  ,  6 
2ESTAB, AA.BH.CB.JCf ,3£S, A? ,3 8 , CC ,CP, G H ,G 7 , At , HU , DSTOHE, IS AE , IS  AH , IS 
3 AG, IGA  B, IBET, EHTT.NKCS,  8CCL) 

BBITE  (i,830) 

CALL  BOCBAH  (IANS) 

IP  ((IANS.3B.IT)  .AND.  (I  A  NS.  NE  .  12)  )  GC  TC  380 
GC  tO  390 

IW00' 

CONTINUE 

IP  (IANS.  IQ.  IT)  GC  TC  400 
IP  (I1NS.IQ.I2)  GC  TC  560 

CONTIS  US 

IP  (IB  ET.  ZQ.  1)  GO  TO  10 
IP  fISET.ZQ.li  GO  TO  10 
CALL  PBTCaS  ( ' CLHSCB N  ') 

SHITS  (5,840) 

CALL  BOCBAH  (IANS) 

- 5.NE.IT)  .  AND.  (IANS.  NE.IZ) )  GO  TC  420 


IP  {(IANS. 

nM  u?« 


.  ,880) 

GC  10  41 C 
CONTINOE 

IP  (IANS. ZQ. IT)  ISAF-1 


75 


( 


r 


t  » 

t  t 


c — 

440 


IF  (IANS.EQ.IZ)  ISAF=Q 

IF  [NO 3 .  EC. 0)  GC  TC  470 
CALI  FBTCHS  ■  ‘ -  ' 

rs  rS,  - 


S  ('CLBSCSM  *) 


BITS  (5,650) 

CALI  B DC HAH  (IANS) 
*  7(1  ANS.NE.IY)  .A 


450 

460 


470 
C - 


15  ( _ 

GC  TO  46 C 
KBITS  (5,880) 

GC  TO  44  C 
CCNTINOE 
I?  (IANS. 20. IY) 
IF  (IANS.EQ.IZ) 
CONTINUE 


DO.  (IANS.  NS.IZ)  )  GC  TC  450 


ISAH=1 

ISAH=0 


480 


IF.  „(NC.E£.0)  GC.  TC _5  10 


-ISAG - 


490 

500 


CALL  FBT 
88ITE  ' 

CALL  a 
IF  ((IANS.NE. I 
GO  TO 


510 
C - 


.  as  ('ClfiSCSN  •) 
(5,860) 

DCEAB  (IANS) 
AHS.NE.IF)  .1 
500 

HBITE  (5  ,880) 

GO  TO  480 
CONTINUE 

IF  (IANS. SO. IT)  ISAG=1 
IF  jlANS.EQ.  12)  ISAG-0 
CONTIS  as 


NO.  (IANS.  NE.IZ)  |  GC  TC  49 0 


520 


I?  (SG.EC.O) 
LI  ?B~*  — 


CALI 


GC  TC  550 
BT  CBS  CCL8SCBN  1 


KBITS  (5,870) 

CALL  a  DChAH  (IANS) 

IF  ({IANS.NE. II) .AND. 


530 

540 


550 
560 " 


GO  W  540 

kbits  js.eao) 

GO  TO  52  0 

CONTINUE 

IF  (IANS.EQ.IY) 

IF  (ians.e3.iz 

CONTINUg 


(IANS. NE.IZ))  GO  TC  530 


IGAN«1 

IGAN=0 


GC  TO 


C - 

570 


KBITS  (5,920) 
STOP 


~T  EBB  IN  ATE - 


1  —  ST  ST 


FOBBAT  (25J,24HGESEBAL  OPTSYSX  CPTIO  NS  : ,  1  OX  ,35HOPTIO!I 
IBB  ANALYSIS  N ITHCUT ,/, 2 2X .3SHCFEN-LO CP  EtGMSYSTEfl  CALCULATIONS.  ,/ 
2/.  10X.42HCPTICN  2  --  STSTEB  ANALYSIS  KITH  OPEN-LOOP,/, 22X, 25HEIGEN 
35TSTEB  CALCULATIONS. ,//, 10X , 39HCFTIO N  3  —  OPEN-LOO&  IlGSfiSYSTEH  F 


580 

590 


600 


FOBBAT  (/✓, 5X.46BCO  YOU  DESIBE  BBS  VALUES  OF  STATE  AND  CONTBOl?,// 

,  10X. ) 9HTIPE  "YES"  CB  "NO".) 

FOBBAT  (/,20X .30BCPTSISX  LQ B /CLASSIC AL  OPTIO NS : ,//. 10X ,4 3 HOPTION  1 
,  —  OPTIBAL  FIITSB  AND/OB  BEG  01 ATOR, / , 22 X, 37HSYNT HES  IS  KITH  NC  EXT 
2EBNAL  "C»  OS  "K",/,22X, 13HBATEIX  INP OT. ,// , 10X ,43H0PTI0N  2  —  OETI 
3BU  FILTBH  AND/OB  REGOL ATCS,/,22X,27 HSYNTBESIS  KITH  EXTERNAL  "C",/ 
4,22X, 13HBATBIX  INPUT. ,// ,  10  X,  5  3HCPTI CN  3  —  OPTIBAL  FILTER  ANO/OB 
5BEGOLATOB,/, 22 X, 2 78 SYNTHESIS  KITH  EXTEBNAL  "K",/,22X. 1 3HB ATBIX  INP 
60T.,//,10X,43BCItICN  4  —  OPTIBAL  FI  LIES  AND/OS  SEGUt ATOH ,/ ,22X. 35 

FOBBAT  (//. 5X,5CaDO  TOO  KISH  TC  DETEBBISE  THE  STEADY-STATE  HESPONS 
1 ! ,/, SX ,27BF0B  A  CONSTANT  DISTUHBANCE7,//,10X,19HTYPE  "YES"  CH  "NC" 


610 

620 


FOBBAT  (5X.47HC0  YOO  NISH  TO  CETEBBINE  THE  30DAL  DIST8IB0TI0N,/,8X 
1.188AND  GAIN  S ATRICZS?.//  ,1 0 X  ,  19HTY P E  "YES"  OR  "NO".) 


630 


ii  Biiiiimi///  i  iu>  •  iiniiri  "iia"  un  "au". 

FCBHAT  (//, 5X ,36BCPEN-LOOP  TRANSFER  FUNCTION  OPTIONS :,//. 1 0X. 53HCP 
1TION  1  —  SO  OPE N-LOCP  TBANSFEB  FUNCTIONS  COBPUTED.  ,// , 10X, 4§80PII 
20 N  2  —  POLES,  RESIDUES,  AND  ZFHCS  CCBPOTED.,//, 101,42 HOPTICN  3  — 
5  ONLY  POLIS  ANt  ZIBOS  CO  BPUTEC.  ,//,  1  OX ,  45  HCPTION  4  —  ONLY  POLES  A 
4ND  BESIDOES  CCBPOTED. ,//, 10 X.32HSELECT  AN  OPTION:  1,  2.  3,  OB  4.) 
FOBBAT  <//.5X,32HSOZ5B  TBANSPES  FONCTICN  OPTIONS :,//, 1 0X, 49 HOPTICN 


64  0 


650 

660 


670 

S60 

690 


700 

710 
720 
730 
74  0 
750 
760 
770 

780 

790 

800 

810 

820 


1  1  —  DO  NOISE  TRANSFER  FONCTICNS  COMPUTED., // , 1 0X#  4 8 HOP? ION  2  -- 
2PCISS,  H  ESIDO  ES ,  AMD  ZEROS  COMPUTED.  ,//  , 1 0  X, 42HOFTICM  3  —  ONLY  PO 
3LES  AND  ZEROS  CC  M EUT  BD.  , //.  1 0  X , 45  HOPT 10  N  4  --  ONLY  POLES  AND  RESID 
4UES  COMPUTED. ,//,  10X ,  32  HS  El  ECT  AN  OPTION:  1.  2,  3,  OS  4.) 

FORMAT  f//,5X.38HCCME£NSATOR  TSAMSFEB  FUNCTION  OPTIONS 1 0 X , 4 9H 
1CPTI0M  1  --  SC  CCMP.  TRANSFER  -UNCTIONS  COMPUT  ED .  ,  /  ,  101,  i  8  HO  P*  ICS 

2  2--  POLES,  BESICUES,  AND  Z E ECS  COMPUTED. ,//, tO 1 , 4 2 HO PTI 0 N  3  —  0 

3NLI  POLES  AND  ZEBCS  COMPUTED.  ,//, 10X ,45BCFTI0N  4  —  ONLY  POLES  AND 
4  HESIDUES  COMPUTED.  , //,  1 5 X, 45  E  NOTE:  A  COMPENSATOR  TRANSFER  FUNCTI 
SON  CAN  3E./,22X,33HCCMPUTED  OKI  I?  EOT  B  A  3 EGUL ATO R,/ , 22 X , 26 H A M C 
6 FILTER  ARE  S  Y NT£  ESI2  ED, /  ,  22X ,  14HAND/CH  INPUT.  ,// , 1 0 X, 32HS *L£CT  AN 
7  CcTIO !l *  1  2  3  C3  4,  j 

FCHMA7  "(//J5 X  J 39  rlW ILL  A  FESD-FCRWARD  DISTRI3UTI0N  S  ATR IX ,  / ,  5X  ,  25  H 
1  "E"  -  MATRIX  BE  INPUT  ?  ,  //  ,  1 5  X  ,  1 9HT  I  PE  "Y  ES"  OR  ■•NO".) 

FORMAT  (/ .5  X,  6  3H  THIS  OPTION  CETSBMI NES  THE  CRITERIA  FOR  DECIDING 
19HEH  A  MARKOV,/, BX, 53HPARAM2TE3  IS  ZERO-THE  MARKOV  PARAMETER  INDIC 
2 ATES  THE  OHD  ER,/.8X(54HOF  THE  MU  HERA  ICR  POLT  NOMIAL  OP  EACH  TRANSFE 
3R  FUNCTION. , // ,  3  X  ,  5  a  BALL  "N"  ZEROS  OF  THIS  POLYNOMIAL  ARE  PRINTED 
40 OT  AND,  /  .8X,S2HTHXS  TEST  TELLS  HC3  MANY  EXTRA  ROOTS  EXIST  AT  Z  * 
50.  ,/,<3  X,4  1HL  ESS  THAN  10.0**  -IE  IS  CONSIDERED  ZERO.  ,//,  6  X  ,  47  H  THE 
6  DEFAULT  VALUE  CF  THIS  PARAMETER  IE  IS  6 . , /. BX, 23 HIN  OTHER  SORES 

7,  IE  *  1 .CE-6.  ,//,10 J.66HIF  YCD  DESIBE  A  DIFFERENT  MARKOV  CRITERIA 

8,  TIPS  TEE  INTEGEo  V  ALUS. ,// ,  1CX, 48H IF  YOU  DESIRE  THE  DEFAULT  VAIU 
9E  TY°E  "Qw  2E&C  ) 

FORMAT  (//,5  X  ,  6 1 HCC  YOU  DESIRE  TO  SYNTHESIZE  A  STABLE  FILTER  OR  R 

3K  d  Y  -  - - -  - 


1 EGULATOK  6Y,/,8X,34HDESTASILI2XNG  THE  CRIGINAL  SYSTEM?,//, 12X,52H 
2  NOTE:  WORKS  ECE  FILTER  OR  REGOLATOP.  BUT  NOT  FOR  ROT  H,/ ,2  0  X  ,  1 7  HIN  T 
3HE  SAME  BUN.  ,  //  ,  10  X  ,  19  HT  YP  E  "YES"  OE  "NO".) 

FORMAT  i5X,53HDO  YCU  DESIRE  TC  PRINT  THE  EULER -LA GRANGE  SIGENS73TE 

1 H ,/ , 3X  ,50  HP  RICE  TC  CECQ  M  POS  IT  1CN  - -  -  “ 

22.10HTYPE  "TES"  CS  "KC».) 


FOB  CHECKING  THE  PROGRAM  ?,//,10 


- - -  -  nwi..  twin  n.  /  u  A 

4R  MUST  BE  RESIDENT  IS  ?H  £  ./ ,  2  2X ,  23H  P  BOG  5  AM  TO  USE  THIS  OPTION.  ,// 
5.1QX.53HCETION  2  —  SAME  aS  OPTION  1  ABOVE  BUT  ONLY  PRINT  THE./, 22 
6  X  ,  34  HR  ESI CUES  CF  EACH  TRANSFER  FONCT ION ,/ , 22X , 28  HUS  ED  IN  THE  SsE  C 
7OMPUTAII0».,//,10X,24HOPTION  3  —  NOT  t ES IRED. ,///, 10X ,29 HSELECT  A 
8 N  OPTION:  1.  t.  OS  3.) 

FORMAT  <//,5X,39HFOWER  SPECTRAL  DENSITY  PSD  OPTION  2  :,//,10X,25 
1 HCPTIO N  1  —  PSD  CCTPOT  NCT  DESIRED.  ,//, 1 0X, 33 HOPTION  2  --  COMPUTE 
2  ONLY  OUTPUT  FSD°  S.  ,//,  1  0  X,  39  EC  PTION  3  --  COMPUTE  ONLY  CONTROL  PSD 
3°S-.//,1CX,50BCETICN  4  —  COMPUTE  BOTH  OUTPUT  AND  CONTROL  PSD°S.  ,/ 
4/,  15X.32HSELECT  AN  OPTION:  1,  2,  3,  OR  4.) 

FORMAT  J//.5X  ,39HCC  YOU  DESIRE  REGULATOR  SYNTHESIS  ONLY? , // ,  10X ,  19 
1BTYPE  "YES"  OR  "NC".,//I 

FORMAT  , 47BENTE8  THE  *  OE  STATES  NS  OF  THE  SYSTEM  MATRIX,/, 

15X,  1  3H  F  — MATRIX  .) 

FORMAT  (/,5X,56B£STE8  THE  #  CE  CCNTRCLS  SC  OF  THE  CONTROL  SYSTEM 
1  JIODBL,/,5X,  13H  "G"- FAT R I X  •> 

FORMAT  J/,5X,54HESTEB  THE  *  OF  MEASUREMENTS  OR  OBSERVATIONS  NO  0 
1FTHB./, 51,136  "H"-MATBI  X  .) 

FORMAT  (/,5X,48HENTEE  THE  »  OF  EBOCESS  NOISE  SOURCES  NG  OF  THE,/ 
1.5X.17H  "GAM  MA" -MAT BIX  .) 

FORMAT  (51, 52  HE  LAG/ PARA  METER  SETTINGS  FCR  THIS  HUH  ABE  AS  FOLLOWS: 

J^ltHAT  (1I,3Higt,2X.2HIQ, 2X,2HIR,2X, 3HISS , 2X, 2HIM, 2X,4 HITF1, 2 X , 4  HI 
UF2,2X,4BlTF3,aX,5HIFDF8, 2X , 2EIE.2X, 6HICE6uG,2 X, 4 6is£t ,2X , 66id6t AB 

^ I^BMAT ^ (IX, 12 , 3X, 12 , 21, 12 ,2X, I2,3I,I2,3X,I2,4X,I2,4X,I2,4X,I2,4X,I 

f6bh1t  f 1X.4  H  f PS  5^2f ^HIX  U, 2X ,5HINOR  fl ,21, 4HIREG, 2X, 2HMS,2X , 2H  NC , 2X 
1.3HNOB,2x,2HNG,/) 

FORMAT  UX,I2,3X,I2,4X, I  2 ,5X , 12 , 3X, I  2 , 2 X , 1 2, 3X,1 2 , 2 X , 1 2 ,//) 

FORMAT  (21,  1 7HCRDEH  CF  SYSTEM  * ,13,// , 2X , 20HNU MBER  OF  CONTROLS  =  .1 
13,//,2X,24HN0HEEB  OF  OBSERVATIONS  = , 13, //, 2X , 3 3HNU3B ER  OF  PROCESS 
2N0ISE  SOURCES  *,I2,////) 

FORMAT  {5X,53H0£TI8RINE  THE  NCEHALIZ  ATICN  PARAMETER  INORM  FOR  TH 
1E,/,5X,55HPOWES  SPECTRAL  CENSITT  PSD  OPTION  YOU  HAVE  PREVIOUSLY. 
2/,5X.52HCH0SBN.  INC  FSD  NORMALIZATION  METHODS  ARE  A V AILABL 2: , // .  ID 
3X.54HMETHCD  1  —  PSD  IS  NORMALIZED  BY  THE  I-NO?.M°TH  PROCES S . / ,2 1 X , 
429HNOTSE  MINUS  "Q"  INORM, INORM  . ,/,21X,49H  NOTE:  "3"  IS  AM  SpSiMaL 
5  STATS  WEIGHTING  MATRIX.  ,/,21X,J4HIN  THIS  METHOD.  INORM  *0,1,..., 
6NG. ,// , 1 CX.63HHETHOD  2  --  PSD  IS  NORMALIZED  BY  THE  INORM  -NG  °TH 
7MEASUR SHE NT,/, 211, 39H NOISE  MINUS  "R"  INCRM  -  NG, INORM  -  NG  . ,/,21X. 
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8,518  NOTE:  "8"  IS  AN  OPTIMAL  CONTROL  WEIGHTING  MATRIX.  ,/.21X,44HI 
9H  THIS  METHOD,  INCH  B  *  NG  »  1.....NG  ♦  NO E. . //, 1 0 X , 5 1 HSEL ECT  AN  IN 
JTEGEa  FRCE  0-16  REPRESENTING  TOUR  PSD,/,  15 X , 27  UNO  DM ALIZ AT  10 X  3E0 
SUIHEM2NTS.,//,1CX,53HI?  PSD  NORMALIZATION  IS  NOT  DESIHED  ENTER  "C" 
S  2E30  ) 

FORMAT  j'5X,43HANALYSIS  COMPLETE.  DO  TOU  3  ANT  ANOTHER  8  OH? ,  /  ,  15X  ,  19 
1  HTTPS  “YES6  OR  "NC".) 

FORMAT  1///.5X  ,48“DC  YOU  WISH  TC  SAVE  T3E  "“"-MATRIX  FROM  THE  LAST 

1  ,/,SX,  JoERUS  TC  EE  USED  IS  THE  FOLLOWING  RUN  ?  ,  //  ,  3  L  ,  3  -  'NO  T  E  :  THE  M 

2  AT8I X  WILL  BE  REDISPLAYED  AT , / ,  5 X . 34 HTH E  PROP S3  INPUT  SEQUENCE  I  NT 
3ESVAL,/,!x,40HANC  YOU  WILL  HAVE  THE  OPTION  OF  CHANG  IMG , / , 5 X , 2 781 ND 
4I7ID0AL  MATRIX  EIEME NTS. ,// ,  1 5X. 198? YPE  "YES"  03  "NO".) 

FORMAT  (///, 5  X , 4  8  EDO  YOU  WISH  TC  SAVE  THE  "8"- MATRIX  FROM  THE  LAST 
1 ,/,5X, 36HFUN  TC  EE  USED  IN  THE  FOLLOWING  ?.  UN  ? ,  //,  5  X  ,  39  HNOT  E:  THE  M 
2ATHTX  WILL  BE  REDISPLAYED  AT , / .5 X , 34 HTH £  PROPER  INPUT  SEQUENCE  I  NT 
3ERVAL,/, 5X,40EANC  TCU  WILL  HAVE  THE  CETION  OF  CH ANG TNG ,/, 5 X , 27HI SD 
41  VIDUA L  MATRIX  E LEM S NTS.  ,// ,  1  5X , 19HT YPE  "YES"  OR  "NO".) 

FORMAT  (///, 5X  ,48HDG  YOU  WISH  TO  SAVE  THE  "G"- MAT  RT  X  FROM  THE  LAST 
1 , /,5X,  36HR0N  TC  EE  USED  IN  THE  FOLLOWING  R UN ?  ,// ,SX ,  39  HNOT  E:  THE  S 
2 ATRIX  WILL  BE  REDISPLAYED  AT . / .5 X , 34 HT H E  PROPER  INPUT  SEQUENCE  TNT 
3EBVAL./,5X,43HANC  YCU  WILL  HAVE  THE  OPTION  OF  CH ANG ING  ,/ ,  5  X  .  27III ND 
4IVI0UAL  MATRIX  HE BE  NTS. ,//, 15X.19HTYPE  "YES"  03  "SO".) 

FORMAT  (///,  5  X  ,  5  2  ECO  YOU  WISH  TO  SAVE  THE  "G  AM  MA"-M  AT3 IX  FP.CH  THE 
1LAST,/,5X,35HBUN  TO  EE  USED  IN  THE  FOLLOWING  5 UN ? ,// ,5 X, 39 HN01E :  T 
2HE  MATRIX  WILL  EE  REDISPLAYED  AT ,/ , 5 X , 3 4HTHE  PROPER  INPUT  SEQUENCE 

3  INTERVAL, /,5X,4CRANC  YOU  WILL  HAVE  THE  OPTION  OP  CH AN  GIN G ,/ , 5X , 27 
4HINDIVID0AL  MATRIX  E LEM  E NTS . ,// , 15X,  19HTY ? E  "YES"  OR  "NO".) 

PCS MAT  (1X.51HWAFNING:  IMPROPER  DATA  ENTBY!  ENTER  "YES"  OR  "NC".) 
FORMAT  (5X.59HOPTSYSX  IS  A  COMPLETELY  INTERACTIVE  OPTIMAL  SYSTEMS 
1CONTfiOL,/,ax,5SfcPFOGFAM.  IT  WILL  SOLVE  NUMEROUS  CONTROL  PROBLEMS  0 
2  S  THE,/,8X,45bECLLCWING  TYPES  CE  SYSTEMS  CONTROL  EQU AT  ION i : , // , 1 5X 
3, 35HXDOT  *  P  <1  *  G  *0  ♦  GAM  •  (W* WO)  ,//, 20X, 22HM EASU8EM ENT  EQ DA 
4tI0N— ,//.15X,21HZ  »  8  * X  ♦  C  *«  ♦  V,//,5ox, 29HRSGULAT0R  PERFCFM 
SANCE  INDEX— ,//,lSX,42HJ  »  1/2  *  INTEGRAL  (Y  «  A  “Y  ♦  U  •  3  *U) DT, 
6// ,2 OX , 3  2HST AT  E  E  EEC  EAC  K  GAIN  CEFINI TIC N— ,//, 25 X , 1 0  HU  =  -  C  »X.// 
7,1SX,4SHCC  YOU  WISH  TO  CONTINUE?  TYPE  "YES"  OR  -NO".) 

FORMAT  ( 25X  ,  1 4  H-- CAT  A  ENTRY— ,//, 5X , 4 9H ALTHOUGH  OPTSYSX  IS  SPECIfl 
1CALLY  DESIGNED  TC  HEAD,/, SX,48SALL  MATRIX  DATA  INTERACTIVELY,  SEVE 
2 £ AL  ALTERNATE, /,5X, 3 1HHSTH0DS  ARE  AVAILABLE  TO  USERS : , //, 1 0 X , 4 3 H BE 
3THQD  1— THE  "F"."G”,  AND  "GAMBJ"  MAT  RIC  ES  , /,  1 3  X,  37HM  AY  3*  READ  PRO 

4  M  SEPARATE  DATA  EILES. , // . 1 0 X , 50HMET HOD  2  —  THE  f,F","G",  AND  "GAMMA 
5"  MATRICES  MAY  BE ,/ . 13X , 4 SHEX I LICITL Y  DEFINED  WITHIN  SUBROUTINE  "S 
6ETUP". ,//, 10X.S2H  NOTE:  IN  SIIEEB  CASE,  THE  USER  SHOULD  OBTAIN  A  C 
70PY,/,  17X.34HCF  IF.E  PROGRAM  LISTING  AND  EX  AMIN  E,  /  .  1 7X,  39HTHS  EXAMP 
8 LES  CONTAINED  IN  S/H  "SETUP".  ,//, 10 X.45HDO  YOU  WISH  fo  CONTINUE? 

9  TYPE  "YES"  OH  "NC".I 

FORMAT  (//,SX,46BC0  YOU  WISH  TC  INPUT  TEE  "P”,  "G",  AND  "GAMMA",/, 
1  1 CX, 4 J HM ATRICES  FROM  SUBROUTINE  "SETUP"  IAW  TH E, / , 1  OX , 40 HM ET HOC  DE 
2SCBIBED  GN  THE  PREVIOUS  SCR ES N7 ,//, 1 5 X , 19HTY PE  "YES”  OR  "NO".) 
FOBBAT  (// ,4 1  H . OPTSYSX  IS  NOW  TERMINATED . ,//) 

INC 


mn  cw  rnnnnriwj  nnnnnnn  nnr. 


E  SS333S3XSS== 


(^301 Jl**  =  a** *S  »«8833»88»isas«3 S3X*a33S3333 3SS3334SS333SS 

SUEHOaTIHZ  S5I3E  | E A,U,  GA3,  ,NC.  tfG) 

C  >■  XX 31  XZZ13X3X«S3333  3SS  33X83S3333S33  3*SS«3333a33«3 

IMPLICIT  BEAL*8 (A-H.0-2) 

DIMENSION  3A  (NS  ,NS)  ,G(!IS  ,NC)  ,  GAM  (NS,  NG)  .CUB  (82, 35) 

COMMON  /EHOG/  10  L,  IQ,  13  ,  ISS  ,1 S  ,IT?1 ,  ITf  2,  ITF  3,  I?  DFB  ,IS ,  IDSTAB,  ID  SB 
10G,ISET,I8£G, IESC.IYfi.INORM 

2 ILE  DEFINITIONS  ~  ~ 


CALL  F BTC MS  (' FILEDE  F  •  *  0 
1  'DATA  ’ , • 


03 

A 


DISK 


•  .  'X29A82 


THIS  IS  AN  E1ASPLE  CF  AS  82  X  35  LATA  FILE  X29A92  DATA  A1  HEAD  FSOM 
A  OSES'S  DISK  AND  CCNVEPTED  (FROM  A  '•DUMMY'*  ARRAY  NAMED  'SUM*)  TO  A 
SYMMETRIC  ARRAY.  THE  FCSM AT  STATEMENT  MUST  MATCH  YOUR  DISK  DATA 
FORMAT  OR  THE  PROGRAM  BILL  FAIL!  NOTE:  AIL  PROGRAM  DIMENSIONS 
MUST  EE  ENLARGED  ACCORDINGLY  FOR  A  SYSTEM  OF  THIS  SIZE. 

HEAD  (3,50)  (  (DUM  (I,J)  ,  1,3ir,I*^,N  S) 

DO  20  1*1 , N S 
DC  10  J=1,NS 

0  CONTINUE 

THESE  ARE  EYAMPLES  CF  SEVERAL  POSSIBLE  METHODS  OF  ARRAY  GENERATION 
B 1TUIN  SUERCUTINE  SETUP. THE  "GAM"  ARRAY  BAS  SET  TO  ZERO  SINCE  NC 
"NCISE"  4  AS  PRESENT,  AND  THE  NCN-ZERC  ELEMENTS  OP  THE  "G"  ARRAY  HERE 
EXPLICITLY  DEFINED.  THEY  COULD  ALSO  3E  READ  FROM  FILES  AS  ABOVE. 


J»1  .NC 
I)  *Q.  JD+0 0 


oc  ao  r*i,ss 

DO  30  J»‘  ' 

GAM  (I,  J) 

GNI.J)  =0  .  CD+0  0 

gm5,  i)*c.  ioooc*oi 

CONTINUE 
CONTINUE 
RETURN 


FORMAT  (5(E12.4)) 
SHE 
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SS3Xtl£4>  3  3S-=3 


E SC 35X3533ZS2 


3UEE0UTINE  CHECK  ( EE  S  ,  NC  ,  NG  ,  NC  ,  IH  ET) 

CHECKS  THE  CONSISTENCY  OF  REQUESTED  OPTIONS.  = 

(IXU333  3335333  3SJ333  3  3SS3  333233333333  3x3  3  XSXZ  S3  Z3  XXX  X  33  323  3  ===•=  =  =  *33 

DOUBLE  PRECISION  IPS 

C08HCM  /PEOG/  IOt,IQ,IR, ISS,IS,ITF1,  ITF2 , ITf 3 , IPDPV , 12 , ID3T AB ,IDEB 
lOG.ISET.ISEG ,IPSD  .IYU.ISOBR 

- SET  BOCAL  A  M  ALY  SIS  SP.ES  OL  EIGESSY S  03  0 L  TF  REQUESTED - 


IF  (IH  .EC.  1  .ABC.  XOL  .  EQ.  01  IOL*  1 
IF  (XOL  .EQ.  3  -OB.  ITF  1  .HE.  C)  13*1 

- CHECK  TO  SEE  IF  H  “ATBIX  INPUT - 

IF  (30  .  HE.  0  .OB.  ICL  .GE.  2)  GO  TO  10 
MBITS  (5,  SO) 

IBET=1 

RETURN 
CCNTINU E 

- TEANEFEB  FUNCTION  CHECKS - 

IF  (IE  .EQ.  0)  1 1=6 
EPS*1 0  .  *  *  l-IE) 

- OPES  LOOP  TF - 

IF  (ITF1  .EQ.  0  .CB.  NC  .  NE  ,  Q)  GO  TO  20 
9  SITE  (5,100) 

IBET-1 

BETUBN 

- CCH PENS ATO B  TE - 

IF  (IT  F3  .EQ.  0)  GO  TO  30 

IF  IREG  .EQ.  C  .ANO.  (NC  .NE.  0  .ANE.  NG  .HE.  3))  GO  TO  30 
MBITS  (5,110) 

IH  ET* 1 
BETUBN 
CONTINUE 

- —NOISE  TF - 

IF  (IT  F2  .EQ.  0)  GO  10  40 

IP  (MG . NE.  0  .AND.  NC  .HE.  0)  GO  TO  40 

MBITS  (5,120) 

ISST* 1 
BETUBN 

- DESTABILIZATION  RESTRICTIONS - 

IF  (IDSTAE  .EQ.  0)  GC  TO  50 
IF  (NC  .EQ.  Q)  GC  TO  50 
IF  (NG  .NE.  0}  IB  EG*  1 
MBITS  (5 ,130) 


MBITS  (5 ,130} 

IF  (IH  EG  .EQ.  1)  GO  TO  50 
I8ET=1 


SETURN 

CONTINUE 

- PSC  INPUT - 

IF  (IPSU  .EQ.  C)  GO  TO  80 

IF  (IPS D  .LI.  0  .08.  IPSO  .GT.  3)  GO  TO  60 
IF  (ITU  .IT.  0  .OB.  IYU  .  GT ,  3)  GO  TO  60 
IF  (INCRfl  .LT.  0  .OB.  INOBH  . GT.  »G»NO)  GO  TO  60 
GO  TO  70 
MBITS  (5,140) 

IRET*1 

BETURN 

IF  (IH  EG  .HQ.  0  .AND.  NC  .NE.  0)  GO  TO  80 
MBITS  (5,150) 

IBET*1 

BETURN 

CONTINUE 

BETURN 


FCBHAT  (//,5X 

ft^llAT  (//,  51 
1  1QX.26HTC  COS 
FCSSAT  f//,5X 
1/,5X,44HIK  TH 
21 S EG  POST  »  0 
FORMAT  (//,5 I 
1  EC,/, 5X, 47HI . 

FOBBAT  (//, 5X 
1 , SX.38HOB  FIL 
2.  THE  BEGOLAT 
FORMAT  (//,5 i 
1,//) 


,49H  R  -  a ATBI Z  BUST  BE  INPUT,  1.2.  "NO"  3UST  BE  >  0. 

,  46  R  (G)  MATRIX  BUST  BE  INPUT,  1.2.  NC  BUST  BE  >  0.,/, 
PURE  OPEN  LOCP  T.  ?..//) 

, 48HBEGULATOR  ANC  FILISB  S 7NTHE SI S  BUST  BE  REQUESTED, 
E  SAHE  BUN  TO  COMPUTE  CCBPISSATOR  T.  F. ,/ , 5X , 47 HI. E . 

. ;  "NC"  AND  "NG"  POST  BE  >  0.,//) 

,§1HNOISE  T.  F.  CALCULATED  ONLY  M HEN  REGULATOR  DESIGN 
e.  IBEG  HUST  *  1.;  "NC"  AND  "NG"  MUST  BE  >  0.,//[ 
,47RCESTABILIZATICN  OPTION  DESIGNED  FOB  A  8  ZGU  LATC  8  ,/ 
TER  EOT  NOT  BOTH  SIBULT ANEOUS LI . , // , 51 , 55  RIF  "NG"  >  0 
CB  OPTICM  IS  AUTCHATICALLI  SET!,//) 

,49H  «»**••****  I  SCO  NS  I  STENT  PSD  INPUT  FLAGS  ******** 


15  J  fCEMAT  (//.5X,<J4fiE0TH  A  aESULATCB  AS  D  PILTEB  J1US7  S  E  &  £SID  E3T ,/ ,  10 
1 X ,  4  2HT  0  CCaP'JtE  TFS  ?SC  0?  A  CCNT30L  LED  SYSTEM!  2.  I  BEG 

2  BUST  3E  0.  ASE  "SC"  SO ST  SE  5  0.,//) 

ESC 


I 
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*******  ************  ****** =*** 


*****  =  a 


SUBROUTINE  INNEB  (NS,NC,MC,NG.N2.ACL,B,3A,CI,Ca,CC,CWI,C'.'3,D,?BGC, 
IFBGE.G  ,gam,gm,gMo,oi,d2  .pbo.bm.bc,  c,sc,wr,..i,3it,-.-21  Tx,  w5o?K,«'l6 

2BMI.DSST  AE,  AA, EH, CM, JCP.BES , AY.BB.CC  ,CP  ,GW  ,G  V,  HE  ,  HU  ,  DS  toES  ,  IS  it ,  13 

.  TBI6 - TCAH  .  TBRT  -BBT»  NB«1  _  Mrr M 


at,  An,  bu(  ag  ,  uwc  ,  r.  u  ,  A  1  ,  as 

JAH.ISAG,  IGAM  ,  I  BE  2  ,  PR  TT,  NH  CW  ,  NCCI) 
********  *******  *  **********: - 

IMPLICIT  BEAL*e  (A-H,C-Z) 


* s  ********  ******* 


COMMON  /EHOG/  IOL  ,1 3  ,IB  ,  ISS  ,  I  R.ITF1 ,  IT F  2,  ITF 
IDG.ISET.IBEG.IFSD.IYU.INOHM 


3, IF DFW, IE. IDSTAE, ID £3 


BIAL*4  FMT  (20) 

C - OUTPUT  OPTIONS  — - - 

C - IOL* 1  IF  THE  OPEN  LOOP  EIG  ENS  Y  STEM  IS  DESIBEO-'OTHEBMISE  IOL=0 

C - IQ* 1  I?  THE  3MS  VALUES  OF  THE  CCSTSOL  AND  STATE  ABE  TO  BE  POUND 

C---ia=0  IF  OPTIMAL  FILTER  AND  BEGULATOB  SIGENSYSTEMS  ASS  TO  BE  POUND 

C - IH*1  IF  EI1EENAL  C  MATRIX  IS  SU  PELTED 

C-— IB*2  IF  EXTEHNAL  X  IS  SUPPLIED 

C - IB*3  IF  EXTEHNAL  C  AND  K  ABE  SUPPLIED 

C— ISS*1  I?  STEADY  STATE  VALUES  ABE  TO  3E  DETERMINED 

C - IM* 1  IF  MODAL  STATES  D  ESI  BED 

C- 


10 

20 

30 


40 


50 

C~- 


NSC=NS*NS 

mh=ns 

M*N2 

CALL  CHECK  ( EES,  NC,  SG, MO ,  IS  ZT) 
IF  (IBET.EC.1)  betl'b:; 

IF  (IS  TT .  iQ.  11  GO  TO  20 
CALL  SEA  CF  (NS.ISAF.cA) 

IF  (IDSTAE.  EQ.  5)  GO  TO  10 
SHITE  (5,1800) 

CALL  BDBEAL  (  A  NS  3 ) 

DSTAR* A  N  SB 
DO  10  1=1,  NS 
OESTAB  (I) =DSIAB 
CONTINUE 
GO  TO  30 

CALL  SETUP  (BA, G, GAN, NS, NG, NC) 
CONTINUE 
WHITE  (6,1380) 

1*1  ““ 


DO  UO 


■1  ,NS 


U «  "V  A  —  I  It'D 

WHITE  (6,1390)  (E  A  (I  ,J)  .  J*1 ,  NS) 
IF  (IDSTAE. EQ.O)  GO  TO  50 
WHITE  (6,1480) 


(DESTAB  (I)  ,1=1  ,  NS) 


CPEN  LOOP  DYNASIC3- 
TO  90 
GO  IC  90 


60 


WRITS  (6,1390) 

CONTINUE 

- *16  INSISTED  OF  THE 

IF  (tCL.  EC.O.  ANE.  IQ.  EO.  0)  GO 
IF  (IQL.EC.O.AND.NC.NE.J) 

00  60  1*1, NS 
DO  60  J *  1  ,N S 
GN  (I,  J)  *  El  (I,  J) 

CALL  SALANC  ( N S ,  SS ,G  N  .LOW  .1  HI GH,  D1) 

CALL  OaTEES  ( N S ,  NS  ,LCS,  I H 1G H ,  GN,  D 2) 

CALL  OHT3AN  ( NS  .  NS , ICW.I  HIGH  ,  G S,  D2.S  C) 

CALL  HCB2  iNS,NS,LOW,IHIGE,GN,CUH,CWI,SC,IZHB) 

IF  iISaa.NE.0)  CALL  EBEXIT  (NS.GN.IEEE) 

CALL  BAL8AK  ( NS,  NS  , LOW,  I  H IG H ,  C  1, NS, S C) 

- NORMALIZE  AND  PHINT  OPEN  LOOP  EIGENSYST2H - 

IWRITE*1 

CALL  CSOEH  (CWH.CWI , SC,  N S .IWRITE , NSQ  ,DDD , D 1 ,  D2 , if  NORM ,W NOHMI , HO , CM, 
ISO, NS) 

IF  (IOL.  EC.  2)  RETURN 

IF  i IQ  .20.0. OB.  (HC.NE.O.OB. IDSTAB.GT .0) )  GO  TO  90 
DC  70  1*1, SS 

IF  (CUB  (I). LI. 0.)  GO  TO  70 
WHITE  (5,1490) 

RETURN 
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70 

80 

90 

100 


110 

120 

130 


140 

150 


160 

170 


180 

190 

200 

210 

220 


230 

240 


250 


260 

270 

280 


290 

300 

310 


CONTI HUE 

IF  (I0L.EQ.3)  GO  TO  130 
DO  80  1*1  ,:is 
DC  BO  J*1  ,NS 
S11  (I,  J)  =  SC  (I  ,J) 

CALL  (MSQ.W  1  1,NS,DDD,D1 ,DI) 

CONTINUE 

IF  (IDSTAE.EQ.C)  GO  TO  130 

-  poan  rj  •  OUG  (DESTAB)  *  ! 

OC  10J  J=1,NS 
DO  100  1*1, NS 

A  A  (I.  J)  sHNORil  (I,  J)  *CESTAB  (J) 

DO  123  1*1, NS 
CO  123  J  =  1 , M S 
DDD*0. DO 
DC  110  K  *  1 ,  N  5 

ODC*0DD+AA  (I  ,  X  >  *  Si  60S  KX  fK,  J) 

DST0R2  ( I ,  J)  =  D  C  t 

coj!xfxo!SA<I'‘5)tDCD 

CALI  3EAEB  ( NO , NS , IS  AH, HOI 
WRITE  (6,1440) 

DC  140  1*1,  NO 

WHITE  (6,1390)  (HC  (I  ,J)  ,  J*1  ,  MS) 

IF  (IH.SE.1)  GC  TC  1*0 

CALL  NODE  ( W  SC  HM  ,HO  ,  C3,  NS  ,S  C,  5S  ,  2) 

CONTINUE 

IF  (ITDFS.EQ.G)  1C  TC  170 
CALL  SEACC  (SC.NC.D) 

WRITS  (6,1470) 

DC  160  1*1,  NO 

WHITE  (6 , 1  j9G  )  (D  <I,J)  ,J*1,NC) 

CONTINUE 

NO2=0 

IF  (SC.  EC-0)  GO  TC  590 
IF  (IOL.EC.31  GO  TC  270 
IF  (IR.NE.1.ANC.IS.NE.3)  GO  TO  213 
IF  (I3ST.E0.1)  GO  TO  180 
CALL  HEACG  ( N  S  ,  tl  C  ,  IS  AG,  G) 

CONTINUE 

CALL  R  FACES  (NC,NS,FEGC) 

WRITE  (6,1400) 

DC  190  1*1,  NS 

WHITE  (6,1390)  (G  iI.Jl  ,J=1,SC) 

IF  (13  .  H  f.  1)  GC  TC  ioO 

CALL  NODE  ( W NC S8I  ,G  , 23,  NS  , SS  ,  SC, 3) 

CONTINUE 

GO  TO  330 

DO  220  1*1, NS 

DO  220  J  *  1 , N  S 

aa(i«-nH,j)=o.o 

CALL  RSACAI  ( NO ,  AY) 

DO  240  1=1, NO 

DO  240  J*1,NS 

DDE=0. DO 

DO  230  K* 1 , NO 

CCC=DDD*AY(I,K)*EC(K,J) 

A  A  (I  ,J)  *DDD 
WHITE  (6,1460) 

DO  250  1*1, SO 

WHITE  (6,1390)  ( A  Y  (X  ,  J)  ,  J*1  ,  N  C) 

DO  260  1*1, IIS 
DO  260  J*1, NS 
DO  260  K=  1 , NO 

RH(I*MH, J)=RN(I*HH,J)+AA  <K,I) *BO(K,J) 

IF  (ISET.EQ.  1)  GO  fo  280 
CALL  REACG  (N  S  ,  NC  ,IS  AG ,  G) 

CONTINUE 

IF  (IOL.EC.3)  GO  TO  290 
CALL  3  FACE  (MC,E) 

WRITS  (6 ,1400) 

CO  300  I*  I, NS 

WRITE  (6,1390)  (G  |I,J)  ,  J*  1,  NC) 

IF  (IH.Sl.1)  GC  TC  3  10 

CALL  3  CD  £  (W  NO  Hfll  ,G  ,  Bfl,  N  S  ,NS  ,  NC ,  0) 

CONTINUE 


-INV  ■ 
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f 

) 


320 

330 

C - 

340 


IF  (IOL.  EC. 3) 
WRITS  (6,1410 
00  320  1=1, MC 
write  (6,1390 
■“  IT  r  1 . EQ. 3 


GO  TO  340 


I?  (IT! 


9  SITE  (6,1500 
riFX-i 

CALI  TF  (H3 , M 


I  io  T<5  ^$0 

OPEN  LOOP  T 

) 


*1.SC) 

a  AMS  FEB  FU  MCTIC  MS  ■ 


350 


1  WR.CWI  .SC.JC? 
IF  (IOL. ME. 3) 


360 


(IOL.  ME.  3; 


S,SSC,EA,AA 
, SES  ,0 1  ,02  , 
GO  TO  *60 


c— 

c 

c 

c 

c 

c 

C 

C 

C 

c 

c 

c~ 


GC 

COMTIMUE 
IF  (13.  EC.  1.0 
■CALCULATION  OF 


GO  TO 
SETUSH 


,  MC,C,HS,NC.  HO  ,CT  ,  IFDF  W,  D  ,  3B  ,CC,CP 
ODD,  EES, ITF1  ,ITEX) 


,  N  R  ,  »  I  ,  C 


R.I3.E0.3) 
CC NT  f CL  GAI 


GO  TO  500 

NS:  FOEKATION  OF  CONTROL  HAflILTONIA 


M - 


-G8*EI*G!1T 


-A 


-FT 


*»«  F  AMD  FT  ABE  THE  OPEN 
DYNAMICS  3  AT 5 1  X  AMD  TR 
**»EI  IS  HCXNC  CONTROL  WE 
MATRIX 

•••A  IS  THE  US XUS  STATE  V 
MAI SIX 


LOOP 
A  MS  ECS E 
IGHTIMG 


***GM  IS  THE  NSXSC  CONTRO 
CISTSIBUTION  MATRIX 


EIGHTING 

L 


370 


380 
C - 


DO  370  1*1, MC 
DO  370  J  - 1, 8H 
PRO  (I  J)  =G  (J,I)/S  (I, I) 

EC  395  I=1,8fl 
DO  380  J*1,8H 

aii(i.j*an)*o.co 

DO  330  X* 1 , MC 

sa(i,j*HE)*aa  (i,j*88)-gji,X)  *erd(x,j) 

- 2MX2M  HAM I LTCMI A  A  MAT  R IX  - 

- DIAGONAL  SLOCKS - Mil  AMD  322- 

DO  390  1*1, MH 
CO  390  J=  1, 8  H 


C-— 
390 
C  — 
4  00 


an  i,j)  »ba  (i ,  j) 

"0  I+SH,  J+8H)  =-EA  (J,  II 


410 


RH  (I+8H, 

-821  SLOCK- 
Bfi(I»1H,J)=-aM(I*BH,J1 

- M12  SLOCK  IS  OEFINEE  IH  LINE  430  ABOVE- 

CONTIMOE 

IF  JIDEBUG.EQ.O)  GO  TO  410 
“~ITE  (6,1510) 

(9  (IX,  1PD  13.  6)  )  •) 


«  B41  b  .  I  -J  I  f 

CALL  3  A  P  B  NT  (  B  ,M  ,8  .  9  ,  RM  ,  4  ,  •  (  9  ( IX,  ' 

CALL  SALANC  (H  ,  8  ,  Hil  , LOW -I  HIGH, El) 

CALL  OHTHES  (8 ,8 ,  LOW  ,IHIG  H,  RH  , E2) 

“‘•,L  08TRAN  (S,a,lOW,IHIGH,afl,C2,*, 

uL  H  C22  (8,  M.LOW.IBIGH,  Sfl  ,  WB,WI,X,  IERB) 
(IE ER  .NE.  0)  CALL  3REXIT  (H , 3H,  I  ERR ) 
it  SALBAK  (M,a,L0W,IHIGH,D1,8,X) 


CALL  08THAN  (8  ,M  ,108  ,IH  IG  A,  BH  ,  E2  ,  X) 

CALL .  -  “  ‘  ~  L 

IF  ( 

CALI  amucnn  ,  j  ,  wn  i.aitfn,  4/  i  ,  J,  if 

-DEBUG  DIAGNOSTICS  CN  SUIEB- LA  GRANGE  EQUATIONS - 

»Plir.  .Eg.  0)  GO  TO  430 


420 
4  30 


440 
C — 


450 

c — 


IF  (IDEEUG 
WRITE  (6,1520) 

DC  420  1*1,8 
WRITE  (6,15301  ifi  (I)  ,WI  (I) 

WRITE  (6;i54Qi 

CALL  R  APRNT  (8 ,8 ,8 , 9  ,X,  4  ,  •  (9  ( 1 X ,  1  PD  1  3 . 6 ) )  • ) 

CONTINUE 

IF  (IDSTAB  .SQ.  1)  GC  TO  440 
IF  (NOB. EC. 0)  WRITE  (6,  15501 
IF  (NOB.NE.0i  SHIIE  (6,1560) 

IF  (NOB.  HE.  0)  GO  TO  750 

^CALL  RGAIM  ( M  ,  NS  ,  SC  ,  SOB  ,  W  B,  WI  ,X ,G3,  W  1 1 ,  58,  W 2 1 , 01  , CAR  ,CWt, S C ,8 HS  ,  D2 

■ — - CHECK  SIGESVECTOSS - 

IF  (IDEBUG  .EC.  0)  GC  TO  450 
WRlfe  (6,1570) 

CALWAPBNT  ( NS,. 'IS,  NS,  9,  SC,  4  ,  '  (S(1X,  1PD13.6)  )  ') 

- RESET  FLAG  ANC  f  SATSIX  FOR  ITERATIVE  DESTABILIZATION  CASS - 

IF  (IDSTAB  .SC.  0)  GC  TO  470 
DC  460  1-1, NS 


84 


KiLi 


BA  II. I)  =EA(I,  I) -DESTAB  (I) 

IE«1 

CONTINUE 

- CALCUIATI OS  OF  EEEDBAC 

- FfIDBACK  GAINS - >  U  *  - (BIN 

- CALCULATE  GT - 

CO  490  1*1, :<c 
DO  490  J *  1 ,N5 
EEC  (I,  J)  =0.00 
oo  480  x=i,aa 

P8CJI,  J)  "PRO  (I.J)  *G  (K.I)  *GN  <K,J) 

PBGC  (I  , J) *-PRG  (I.  J)/E(I.I) 

IF  (IOSTiE  .EC-  ')  GO  TO  500 

- NORMALIZE  ARC  PRINT  OPT.  REG.  CLO 

IBHITE=2 

CALL  CNOEB  (  C3  R  ,  C'«  I,  SC,  NS, ISSUE,  NSQ 
1  A  A  ,  NC  ,  US) 

- THE  OPTIMUM  FEEDBACK  COHT 

BRITS  (6,1580) 

DC  510  1  =  1.  NC 

BRITS  (6,1590)  (FEGC  |I,J)  .J*1  ,NS1 

- COMPUTE  MODAL  C  BAISIX  OPEN  LCO?  0 

IF  (13  .  N£.  1)  GO  TO  530 


K  GAIN - 

VERSE)  *GT*GN 


SED  LOOP  SIG2N3YST2B - 

.ODD , D  1 ,  D2  ,  iiNORB,  W N08BI  ,  F3GC  , 


SOL  G  AIN  S* 


•INVERSE  SAVED  IN  WNORBI 


J  COEPUTING  BODAL  C  RECOMPUTE  U  CFEN  LO 
6  O-INV  FOR  CLOSED  LOOP  SYSTEMS;  .NORM 


CP  SINCE  WN0R3  USED  TO  STORE 
I  USED  TO  SAVE  U-INV  OPES  LOOP 


DC  520  1  =  1, NS 
DO  520  J*1,NS 
WNCRB  (I,  J)=WHOBHI  (I,  J) 

CALL  3  IN  V  [  NSC, WNCRB,  US, ODD, D1rC2) 
CALL  30DE  W NC SB. t BG£, A  A , NS , NC , NS , 3) 
CONTINUE 

- TEE  CLOSED  LOOP  DYNAMO 

DO  550  1*1, NS 

DC  350  J=1,BS 

SUM=0. DO 

CO  5«0  X * 1 , N C 

SDB=SUB*G  (I ,  X)  *F BGC  (K,J) 

ACL  (I,  J)  =£A(I,J)  *SUH 
WRITE  (6.1600) 

CALL  3APRNT  ( 8 H ,  MH  ,  3H ,5  ,  ACL,  4  »  (5  (1 X 
IF  (IR.NE. 1.ANC.I8.NE.J)  GO  TC590 
DO  560  1*1, NS 
DO  560  J  =  1 ,  !I  S 
GN  «, J)  =AC1  (I.J) 

CALL  BALANC  (  fi  S ,  NS,  GU  ,LO  V  ,1  HIGH,  D  1) 
CALL  ORTHES  ( NS  ,  NS  ,ICW ,  I H IGH ,  G  !i,  D2) 
CALL  ORTSAli  (N  S  ,  US  ,LOS ,  I  HIGH  ,  GN  ,  D2,  S 
CALL  H  OR  2  (NS  ,  NS  ,  10 W  ,IHIG  H,  G  N  ,CSS  ,CW 
IF  (IEBR  . if E-  0)  CALL  EREXIT  (NS.SN, 
CALL  3  ALBAK  ( NS , NS , LOW . I H IGH , C 1 . NS , S 

- NORMALIZE  AND  PRINT  CLOSED  LOOP  SO 

IHaiTS=3 

CALL  CNOHB  (C SB  ,CSI , SC, NS ,1  WRITE , NSQ 
1AA.HC.SS> 

DO  57Q  1*1, NS 

IF  (CVR(I) .LT.0.0)  GOTO  570 
WRITE  (5,1610) 

BETUBN 
COHTIN  OE 

IF  (IQ.NE.1)  GO  TC  590 
DO  580  1*1, NS 
DO  580  J*1,NS 
W11  (I.J)  *SC  (I.J) 

CALL  SlNV  (NSC,311,NS,DDD,Dl,D2) 
NOB*NO 

IF  (  NG  .  EC.  0)  RET0R5 
IF  (ISET.EQ.1)  GO  TC  610 
CALL  3  EACG2  ( NS,  NG,  IGAB ,  G AH) 

CONTINUE 

IF  (IOL  .EQ.  3)  GC  TO  620 
CALL  REAOC  (NG,C) 

WHITE  (6,1420) 

DO  630  1*1, NS 

WBITE  (6,1390)  (GIB  (I.J)  ,  J*1,NG) 


S  MATF.IX- 


,  1PD13.5) )  *) 


C) 

1 ,5C,  IEBR) 

I  ES  3) 

C) 

BOPT.  BEG.  3IGENSYSTEB- 


,D0D,D1, D2, WNOBB, WNORBI, FBGC, 


85 


i 


If  (IH.NE.1)  GC  TC  640 

CALL  MODS  (WNCBai  ,3  AH,AA,  NS,  NS,NG,  1) 

CONTINUE 

IF  (IOL  .EQ.  3)  BHTOEH 
8  BITE  (6,1430) 

DO  650  1*1 ,  NG 

W  SITS  (6,1390)  (Q(I,J),J*1,MG) 

IF  iiXa.HC.O)  .A6D.  (NG.SQ.O)  )  GC  TO  1260 
DO  060  I  *  l,NG 
0 O  660  J=1,NS 
ESC  II.  J)  *0.  UO 
DO  660  K*1,XG 

PSC  (I.  J)  *F30  (I,J)  *Q  (I,X)  *GAM  (0,K) 

DO  o7J  1*1, NS 
DO  670  J*1,NS 
CO  (I. J)  *C.OO 
DO  67'J  K=1,NG 

CQ(I,J)  *CQ(I,J)-GA8  ( I ,  SC )  *  FRO  (F,J) 

If  (is  EG  .EQ.  1)  GO  TO  690 
-CALCOLATION  OP  FltlES  GAINS  :POBBATION  CF 


EAT  I  ON  CF  ESTIMATION  HAMILTON  I A II- 


-GM*Q*GMT 


-RCT*8IS»HO 


***F  AND  FT  ARE  SAME  AS  FOR 
CCNTFOL  HAMILTON  IAN 
***Q  IS  NGZNG  STATS  DISTUSBANCE 
R COVARIANCE 

***R  IS  NOXNO  UEASUREHINT  NOISE 
3CC7A3IANCS 

*»*HC  IS  NOXSS  MEASUREMENT  SATE  3 
***5.1  IS  NSXUG  STATE  DISTURBANCE 
D 1ST  ft  I EOT ION  MATRIX 


CALL  SHADE  INC  ,3C) 

MBITS  (6 , 1450) 

DO  660  1*1. NO 

MBITS  (6,1390)  ( ?.C  (I ,  J)  .  J*  1  ,  HC) 

IP  (ITP2  .EQ.  C)  GO  TO  ?0  0 

- NOISE  TSANSPSfl  F0NCTIONS - 

WHITE  (6,1620) 

ITFX=2 

I2ERO*0 

CALL  T?  JNS,NS,NSQ,ACL,AA,tlG,GAS,3a,  NO , HC , CM ,IZ2RO , D , 3B ,CC , CP , W E 
181  ,CMR  ,C  «I ,  SC  ,  JCF.SEEjDI  ,D2  ,DDD,£ps)  ITF2,  ITPX) 

I?  (IS  EG  .EQ.  1)  Retubm 
CONTINUE  ' 

IF  (IS  EG  .EQ.  1)  GO  TO  930 
IF  (IS. LT. 2)  GC  TC  710 
CALL  SSAEIE  (NS, NO, PEGS) 
go  ro  aio 

CCNTICIOE 

- - - THE  SEA  S  QBE  SENT  SAT  BIX  (HOT*8I N*HO===>SC - 

DO  720  1*1, NO 
DO  720  J* 1 ,HH 

DpoBcm:?^'J,/ac<I'I) 

DO  73J  J*1,3H 
Ba(I+1H,J)*0.D0 
DO  730  K»  1 , NO 

b«(I4«h,  j|  *a a  (i+as,  j)-so  (x,i)  *fbo  <k,  j; 

- GS*Q*GHT**=>CC - 

DO  740  1*1, NS 
DO  740  J  *  1 , N  S 
aa  /i,j) *baji,J) 

HH  I*MH,  J+MH)  *-EA  (J,  I) 

B N  (I ,  J ♦  N S)  *CQ  (I,J) 

GO  t6  400 

BACK  TO  u«C  TO  SET  DP  THE  FILTEB  H AST  LTC HI AN;  CALC. THE  FILTER  GA] 
CALL  AGAIN  (M .  NS ,  NC^  NOS ,  8  Bj 8 1 ,  X^GN^G  3  ,3.1,821,01  ,  CH  ,CI ,  PRO  ,  3HS ,  t 


,11  ’tium,  j 

)*GBT**=>CC- 


IF  (IDEBDG  .EQ.  0)  GO  TO  760 
SHITE  (6,1570) 

CtlL  8AP8NT  (NS,NS,NS,9,PHO,4,’(9(1X,1PD13.6)) ') 

CONTINUE 

IF  (IDSTAE  .  EQ .  1)  GC  TO  770 

- NORHALI ZE  AND  PH  I NT  OPT.  ESTI HATCH  EIGENSTSTES - 

I8HIT3*4 

CALL  CNOBH  (CB,CT,PfiC,!15,I8RITE,NSQ,  CDD,D1,02,  JNOSil ,  3NOBKI  ,  HO ,  A 1 
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770 

780 

790 


800 

810 

820 
C — 


830 
C — 


840 

850 


860 

870 


C - 


aao 

890 

900 


910 


920 
9  JO 
c— - 


1N0.NS) 

DC  780  1=1. 3H 

DO  780  J*1.MO  , 

FSC  (I.  J)  **80  (J.I)  /SC  (J,  J) 

DO  790  1=1,88 
DO  790  J=1.NO 
FBGS a ,J) =0.00 
DC  790  K=1,3H 

FBGE (I,J)*F3GE  (1.2)  *GHJI,K)  *FEC  <R,J) 

IF  (IDSTAE  .EC.  1)  GO  TO  810 
WRITE  (6,1670) 

CALL  SAFEST  ( <1  S,  3B  ,  »H,5  ,  G  N.  4  ,  >  <5  ( IX ,  1  PD  1 J .  o)  )  • ) 

WHITE  (6,1630) 

DO  800  I  *  1 ,  NH 
X  (1,1)  =DSQ3T (GN  (1,1)  ) 

«  R I  »  2  (6,1690)  (X  ll, I)  ,1*1,38) 

WRITE  (6,  1b  JO  ( 

do  820  i*i. an 

WBITE  (6,1640)  (FEGE  (I.J)  ,J=1,NO) 

- COMPUTE  SOD  A I  8  SATHIX  OPEN  LOOP  U-INV  SAVED  IS  WNOaSI - 

IF  (13  .  NE.  1)  GC  TO  830 

CALL  3  COE  (WHO  EM  I.  FEGE,  A  A  ,BH  ,  »B,  NO,  4  ) 

CONTIS UE 

- BESET  UAG  AND  l  MATRIX  FOR  ITERATIVE  DESTA 31  LIZA TIOS  CASS - 

IF  (IDSTAE  . SQ .  0)  GC  TO  350 
DC  340  1=1,  SS 
DO  840  J*  1 , NS 

BA  (I,J)  »EA(I,J)  -CSTORE(I,J) 

IR=2 

CONTINUE 

DO  870  1=1, NS 

DC  970  J=1,NS 

sna*o. 0 

DC  360  K  *  1 ,  N 0 

SCK=SUM«-F2GE  (I.K)  »8C  (K,  J) 

EEC  (I,  J)*cAJi,J)  -SUM 

UD  r*i<T7  (5  loD'l  ) 

CALl“hAp6nt  (ks.NS,NS,3.PHO,«,'  (5  (1X.1PC13.S))  •) 

IF  (13  .  IT.  2)  GO  TO  »9  0 

CALL  3  A  L  A  SC  ( SS  ,  S  S  .?  50 .  LO  W,  18  IGfi ,  D1 1 

CALL  oaTEES  ( N S ,  NS  .LOW,  I  HIGH  ,  EHO , 02) 

CALL  ORTSAN  (  NS  ,  NS  ,  IC8,  I  HIGH  ,  f  50 ,  C2 ,  GSI 
CALL  HQ32  (NS,NS,IOS,IHIGH,?aC,CR,CI,Ga,IEaa) 

IF  (12 SP  .S3.  C)  CALI  EBEXIT  ( NS ,  PRO ,  12 EH) 

CALL^B ALEAK,  ( NS,  SS  .LOW,  I  HIGH  ,  D  1,  SS,  G  S) 

dog  HALITE  AND  PHINT  SUBOPT.  ESTIMATOR  El  73  MS  I  ST  EM - 


940 

950 


IWHIT3=5 

CALL  CNOEfl  (Ca,CI,GM,NS,IWRITE,NSa,DDD,D1,D2,WNOHM, W NO RHI, HO , A A , 
INC,  SS) 

DO  880  1=1. NS  „  „ 

IF  (CB  (I) -LT.  0.0)  GO  TO  880 
WRITE  (5,1660) 

RETURN 
CONTINUE 
GC  TO  900 

V  fi3-fSiVc  IC  1260 

DO  910  J* 1 ,3H 
EEC  (I.J)  =0.00 
DO  910  K* 1 , NO 

EBC  (I,  J)  =EHO  (I.J)  <RC  (I.K)  *F3GE(J,K) 

DO  920  1=1, aa 
DO  92 0  J*  1,(18 

S8W!!i5So 

CQ  (I ,  J )  =CQ  (I.J)-FEGE  (I.K)  *PR0  |*,J) 

CONTINUE 

- THE  RMS  STATE  AND  COST 50L  RESPONSES - 

IB«IB+  1 

GO  TO  (1050,1090,540,940),  IB 
DO  950  1=1, NS 
DO  950  J  =  1 , N G 
X  (I.J)  =0.0 
DO  950  K *  1 , NG 

X  (I,J)  *X  (I.J)  *GAM  ( I , K)  *Q  (K.J) 
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960 


970 


980 


990 

100C 


1010 
102  C 


1030 

1040 


1050 

1060 


DO  970  1*1, M3 
DO  970  J*I,NS 
SUR=0.  0 
DO  960  K  *  1 , NG 
S0fl*S0fl  " 

PHO  “  * 

PEC  .  . 

CC  (f  ,J)  =  SU3 

-  ■  o  *sca 

,  j)  =ca  (i,oi 

9  21  <J,I)  *GM  (J.I)  „ 
CALL  3INV  (NSC  ’ 
CALL 


*S0H-X  ll.K)  *GA i!  (J,X) 

(1,0)  *SUH*CC(I,J) 

JJ,  Ij  f  E?.0  <I,J) 

_  .1*  t  ] 

3INV  7.*iSi7921,SS,DDD,D1,C2) 

SCON  (NS,G3,921  ,C2  ,  Cl ,  NS  ,GR ,  92 1  , C3 , Cl , PRO , GN) 
H8IT2  (6,1670) 

CALL  3  APRNT  (  3H .  3H  , BH,5  ,  GS,  4 ,  •  I 
8RITE  (6,1680) 


(5  ( IX ,  1ED13.0)  )  •) 


CO  980  1*1, BH 

55  IJ36Eli1U?c  ‘c 

DO  1000  J*1,NS 

SUB=0. 0 

DO  990  K*1,NS 

SUfl*S(J  3+FHGC  (  X  ,  A)  *GN  (K,J) 

X  (I.J)  “SUB 
DC  1020  1*1, NS 
DC  1020  J*1,SS 

sub-o.o 

If  (NC.  EC-0)  GC  TC  1020 
DO  1010  K*1,;iC 
SUK=33i*»G  (I,K)  *X  (K,J) 

PRO  (I.J)  *ca  (1,0)  +  sue 

CALL  S  COV  (NS,  SC,  SI  1  .CVS  ,CS  I ,  MS  ,G3,  W  2 1  ,  C  3,CI  ,  2  30  ,  BA) 

IP  INC.  SC.J)  GC  TC  1C40 

DO  1030  1*1, NC 

DC  1030  J*1,NS 

821(1.  J)  *C.O 

DO  1030  K*1.SS 

821  (I,  J)  *921  (1 , 0)  ♦FBGC  (I  ,  K)  *B  A  (J,  K) 

co  loSo  i*i,:;s 

DO  1060  J*1,NS 

soa*o.  o 

IP  (NC.EC.O)  GC  IC  1060 
DO  (050  K*  1,  NC 
SDB-SUB+G  (I.K)  *921  (K,J) 


EEC  (I.  J)  «SUB 
DO  1070  1*1, NS 


1070 


,911,CHR,CHI,NS.SC,B  11  ,C  SR  ,C9I  ,  PRO  ,  CQ) 


1080 


1090 

hoc 


DO  107  0  0*1, N  S 

FBC  (I,  J)  *ERO (I,J)  ICQ  (I,J)  +PRO  (0,1) 

PHO  (J.lj*EBO  (I  .0) 

CALL  SCOT  (NS , 5C , 9 
DO  1080  1*1, NS 
EC  1080  J-I.NS 

GR  (1 ,0 )  -CC  (t  ,  0 )  -E  A  (I  ,0)  -  3  A  (0  ,  I)  *GN  (I  , 0) 
GB  (J.I  -Gil  (1,0 
GOTO  11  CO 


CALL  SCOT  (MS, SC, 911. CHR, CHI.JIS.SC, 9  11 ,  C  «R  ,CBI  ,C0  ,GB) 
I?  (NC.EC.l))  GC  TC  1  150 
DO  1120  1*1, NS 


1110 

1120 


DC  1120  J* 1 , NC 
PRO  (I.  J)  “C.OO 
DO  1110  K* 1 , NS 

PR0j|I^J^*PR0  (1,0)  *G 8  (I.K)  *PBGC  (J,K> 


1130 

1140 

1150 


CON' _ 

DO  1140  1*1, NC 
DO  1140  J*1 , MC 
SC  (I,  j)*C.D0 
DO  1130  K* 1 , N  S 

SC  (I,  J)  “SC  (I ,  J)  ♦  PBGC  (I,  K)  *PRO  (K,J) 
CONTINUE 

I?  (13  EG  .EQ.  0)  GO  TO  1170 
DO  1160  1*1, NS 
DO  1160  0*1. NS 


uu  I  low  *P  J 

1160  §&,Ir6J)ni8(i'J) 
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1 17C 


1180 

1190 


1200 

1210 

122C 

1230 

124C 


1250 
1260 
C—  — 


1270 

1260 


1290 
C— ■ 


WRITE  (6,1700) 

CALL  2  A  F  o  NT  ( SB,  ME,  3 E,5  ,  GM.  tt  ,  •  (S  ( II,  IPO  1 3-6)  )  ') 
IF  112. GT. 2)  5C  IC  11^0 
CO  1180  1*1, MH 
DC  1180  J-1.M8 

c8NlfMa£<3tMi'J)*GE<I'J) 


130  0 
1310 


13U0 


WRITE  (6.1710) 

CALL  3APSNT  ( M  E,  3  £ ,  M  6,5  ,  CQ,  4  , 
IF  (NC  .EC-0)  GC  IC  1210 


’  (5(11,  1PD13.6)  )  •) 


WRITE  (6,1720) 
DC  1200  1*1. NC 
WHITS  (6.1730) 
00  1220  1*1, NS 
C 


(SC  (I  ,J)  ,J*1,NC) 


UU  (  J  A  "  I  •  tl  J 

SJ'teliSSf'M'iSl. 


SSliiil 


,  SC  (1,1) 


1350 

1360 


1370 


C - 

C67  0 
1380 
1390 


DO  1230  1*1, NC 
SC  (1,1)  *CSO$T  (SC  (1,1)) 

WRITS  (6,1740) 

DO  1250  1*1, NS 
IF  (I.L2.NC)  WRITS  (6,1750) 

IF  (I.JT.NC)  WRIT!  (b,  1750) 

CONTINUE 
IF  (IT  F3  .£0.  0)  GO  TO  1290 

- PORN  CCflPSNSAIOa  FROM  (1  £A 5  IC  INPOT  AND  COMPOTE  TP - 

DO  1280  1*1, NS 
DO  1280  J«1,NS 
soa»o.  CO 
DO  1270  K*1,30 
SUB=SUM*FEGE(I,K)  »HO  (K,J) 

S2i^J,,6^I0,'J,-SDK 

ITFX*  5 
IZERO*0 

CALL  TF  (NS,  NS  ,  NSC,  CC, A  A  ,  NO  ,  FEGE  ,  31 ,  NC  ,  FBGC,  CM  ,  T  ZERO  ,0  ,  BB  ,  CC  ,  CP 
1  SR ,  WX ,  CWR  ,CWI  ,SC  ,2CF  ,a£S  ,D1 , 02  ,DDD,  E PS ,  IT F3,  ITFX) 

CO  NT  IN  U  E 

- COMPOTE  PSD  FUNCTIONS  OF  THE  CONTROLLED  SYSTEM - 

IF  (IPSO  .  £Q .  0)  GO  TO  13  10 
IF  l IYU  .LT.  3)  GC  TC  1303 

CAli  PSDCAL  (B,NS,HS,X.NC,GW,GV,FDGC .  NO  ,  HI  ,H  U  ,  HO  .  F3GE,  NG  , 

1  GAM,ACL,BA,Wfi,WI,D1 ,D2 , JCF ,SES,C,RC,EE,CC,1  , if SO, INORM) 

CALL  PSDCAL  (  M  .  NS  ,  R!  ,X,  N  C,GW  ,  G7  ,  ?SgC  ,  NO  ,  3  Y  ,  3  Y  ,  i!0,  F  3  GE ,  NG  , 

1  GAM, ACL.SA, WR,WI, 01, D2, JCF, SES,C, SC, £E,CC, 2  ,l£sD,INORM) 

GO  TO  1 3 1 G 

CALL  PSDCAL  f  M  ,  NS  ,  HM  ,X,  N  C,G  W  ,  GV,  FBGC  ,  NO  ,  H  Y  , .( U ,  HO  .  PE  GE,  NG  , 

1  GAM  ,  ACL  ,BA ,  4  R  ,  WI  ,D  1  ,02  ,  JCF  ,  RES,  C,NC  ,  £E,  CC,  IYU  ,  IPSO,  IN03M) 

IF  (ISS  -EO.  0)  3ET06N 
IF  (NC  .NE.  0)  GO  TC  1330 
DO  1320  1*1, NS 
DO  1320  J* 1 , N S 

CALL  .1 1 N  V  (NSQ  ,  JCI ,  NS  ,DDD  ,01  ,E2) 

CALL  R  EACH  (NG.WR) 

WRITE  (6,1770)  (WB  (I)  ,1*1  ,NG) 

WRITE  (6  J  1780 ) 

DO  134<)  1*1,  NS 
WI  (I)  *0.  0 
DO  1340  J*1 , NG 
HI  (I)  *WI  (I)  ♦GAB  (I,J)  *WR  (J) 

DO  136  0  1-1, NS 
CB  (I)  *0.  0 
DO  1350  J-1 , N S 


CB(I).*CB(I)-ACl(I,J) 
WRITS  (6,1390)  CB  (I) 
DO  1370  1*1, NC 


J)  «WI(J) 


c  V1W-0 


DO  1370  J*1 , N S 

CIJI)  «CI  (I)  »FEGC  (I,J)  *08(0) 

WRITE  (6,1790)  (Cl  (I)  ,1*1  , SC) 


RETURN 


PCHSAT  (2Z, 1P6C14.6,/,2X,6D14.6) 

FORBAT  //,5  X , 45HCFEN  LOOE  OYUBICS  BATRII . 

FOSBAT  I  10  (2X  ,  QPC  1 1 , 4) ) 


//) 


89 


moo  f  c  as  at  (//,5x.45bthe  control  distribution  matrix . a..,//) 

1410  PORHAT  (//, 5K , 45HTH E  CONTROL  COST  MATRIX . 3..,//) 

1420  FORMAT  ( //, 5  X  , 45  HPRCCSSS  NOISE  DISTRIBUTION  MATRIX . GAM  M  A •  .  ,//) 

1430  P0S3AT  (//, 5X,U5HFCR£R  SPECTRAL  DENSITY  -  PROCESS  NOISE - C. . .//) 

1440  FORMAT  1 //, 5 X , 45 HME A  SORB M2NT  SCALING  MATRIX . H..,//) 

1450  FORMAT  (//,  5X  ,  45.HFCW  ER  SPECTRAL  DENSITY-MEASUREMENT  NO  ISE.  .  R .  .  , // 

1460  FORMAT  ""  1 

1410  FCEMAT 
14d0  FORMAT 

1VING  VAL'Jcj  uu.  =c  auuc.*j  .  . 

2TRIX  TO  DESTABILIZE  IT. ,/ , 1 0 X  ,41 HOPT IMAL 
3D  SYSTEM,/. 10X,39EARt  THEN  USED  AS  FIXED 
4 HF03  THE  SYSTEM  C  ALC  OLATI  CNS  .  ,//} 

FORMAT  (///4  3  H  FRCGfl  AM  TERMINATING  DUE  TO  UNSTABLE  SYSTEM) 

FORMAT  |//,2X,31HCPES  LOOP  TRANSFER  FUN - 

FORMAT  }//,5X , 22B  EOLEE-L AG  RANGE  SYSTEM 
PORMAI  |//,1X,43HEIG ZNV A LUES  AND  EIGENV 


GAINS  FOR  THE  DESTABILIZE 
SU30PTI MAu  GAINS,/, 10X. 28 


1490 
1500 
1510 
152  C 

1530 

154C 

1550 

156C 

1570 

158C 

1590 
1 60  C 
1610 

1620 

1630 

1640 

1650 

16oO 

1670 

16rtf 

1690 

1700 

1710 

1720 

1730 

1740 

1750 

176C 

1770 

1780 

1790 

iaoo 


CTIONS. . . ) 

MATRIX... ,//) 

lunnn.  <  / /  ,  1  X  »  4 3H  SIG  ZfiV  A LUE 5  AND  EIGENVECTORS  OF  THE  2N  X  2N,/,2X, 

145HE0LES-LIGRANGZ  SYSTEM  AFTER  HQ82 . ,//) 

FORMAT  (IX,  1P2E13.6) 

FORMAT  (IX) 

FORMAT  (//, 2 X, 4 1 HETGENS YSTSS  OP  OPTIMAL  REGDLATOR . ,//) 

FORMAT  ( // ,2  X  ,  4 1 HEI3  ENS  YSTS  M  CF  OPTIMAL  ESTIMATOR . //) 

FORMAT  *“  -  -  -  “  . 

FORMAT 

1»GT*S.  ..  ,//) 

FORMAT  ( 1C (2 


//, 5  X , 39  R  EIGENVECTORS  FROM  RGAIN  PRIOR  TO  CNO  RM ,//) 

//,1 X , 57 J1H E  OPTIMAL  FEEDBACK  GAIN  CONTROL  MATRIX.  . . C  =  8 IN7 


(2  X  ,  IPO  11.  41) 


F-G*C..,//) 
ABLE  CLOSED  LCOF 


GAINS . X..  ,//) 


‘H  ROUGH  THE  CLOSED  L 

100P  SYSTEM.. ,//) 

FORMAT  (//,5X, 45HEILTE2  STEADY  STATE 
FORMAT  (  1  X ,  2  X  ,  1P6C14  .6) 

PORMAT  (//. 1 X , 43  HTH  E  CLOSED  LCC?  PILTE?  DYNAMICS  MATRIX  IS..,//) 
FORMAT  (////, 43H  PROGRAM  TERMINATING  DUE  TO  UNSTABLE  FILTER) 

FORMAT  (//,5i  ,  45HTUE  COVASIAiiC-  OP  THE  ESTIMATION  SRRG  //) 

FORMAT  !/^,5X,45H5MS  VALUES  OE  THE  ESTIMATION  ERROR . ,//) 

//) 
//) 


FORMAT  {  (5(1  X,  1PD13.a|  )  I 

FORMAT  )// ,  5  X  ,  45  HT  fi  E  COVARIANCE  OF  THE  ESTIMATE . XH  AT . . , 

FORMAT  (//, 5X , 45H TH E  STATE  COVARIANCE  MATRIX . X=XHAT  *  P..., 

PORMAT  (//, 5 X  , 45HTH E  CQNTSOL  COVARIANCE . J«C* XH AT*CT . . . , 

FORMAT  ( IpoDl  4 .0) 

FORMAT  (//.2X.18HSTATE  RMS  RESPONSE, 20X , 20 dCONTROL  RMS  RESPONSE,/) 
FCEMAT  (IX* 1p£  15.7.25X, D15.7) 

a.n.i  ,  I  .  .  -v  cnur,  .rBiie  i,na  I'v.Mc&wn  -r  11 1]  r- ..  ."MJ  r-  D«n«  ur.c  *l«n  TVPU 


FORMAT  i//,5X,50KC(5  M  FENS  ATOR  TRANSFER  FUNCTIONS  FROM  M  EAS.  TO  INFO 

IT ,  /,  SX  ,  5  zH . U/Z  »  -C»  (SI-F*G*C»K*H)  INV»K.  ..,//) 

FORMAT  (//.  2X  ,  46  HST  E  ADY  DISTDREANCE  VECTOR . b..,// 

1.10(1X, 1P012.4/n 

FORMAT  (//,5X,45HSTEADY  STATS  VALUES  OF  STATS  VAR.  ARE. 

FORMAT  f//,5X,47HSTEADY  STATS  CONTROL  IS 
1/10(1X. 1EC12.4/1) 


// 

//) 

•  ,/ 


(IX,  1PC12.4/1) 

FORMAT  i//,5X.49HENTER  THE  MAGNITUDE  OF  THE  DESTABILIZATION  7ECTCR 
1 ,/,8X,47RTO  Be  ACCEC  DOWN  THE  DIAGONAL  OF  THE  " FM -MATRIX,/, 31,18 HT 
20  DESTABILIZE  IT.,//) 

ENC 


90 


C*»* 


10 

20 

30 


3sxxaxnss3ssx»asnca3s3ss33sasm  3333333333333333333333  33:333 


SO  £300  TI N  E  B  A  E  ENT  (N MAX  ,  0  ,il  , L , A, IDIM  ,  FRTJ 
REAL *4  A  (NMA X  ,  N) 

DIMENSION  FHT(IEIH) 

NO*L 


DC  20  SL  =  1 ,  N  ,  I. 
IF  (NU.31.N)  N 
OC  tO  1=1,.'* 
WHITE  (6,r«T) 
KBITS  (6,30) 


C*S 

(A  |I, J)  ,J=  N l,  NO ) 


BETORN 


FORMAT  (IX) 
END 
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C****s,***:s  =  ;*=;s********33*a6s=s=  ass  saxassass  ass  a  as  as  as  =*  ass  s  aa  ssa  a  as 

SUBROUTINE  RG  A  IN  (B  ,  NS,  NC  ,'J  CR  ,  •  S  ,  BI ,  VF,  GN ,  R  1 1 ,  TCS,  R  2 1 ,  LT.  C ,  C 
1  HS , NT) 

IMPLICIT  REAL'S  JA-H.0-2) 

DiaSNSION  JB(H),ai(nj,7?(Nta)  ,GN  (MS.  MS) 

DiasNsio s  ail  (ns, ssi  ,?C3jN,af  ,s2i<ns  ,ns)  ,lt(hs)  ,mt(nsj 
DIMENSION  C(3S),CI|li5),CT  (Ss  ,  Ss) 

KF»1 
KN*1 
NRZ2V*0 
NCEZEV  =  0 

10  IE  (K.GT.3)  GC  10  210 

C - - - - - 

C  CHECK  ?03  BIG  VA  L  AT  Cf  NEAR  J-ONECA  AXIS  TO  INCLUDE  IN  E-L  EIG3Y5 
C  TORN  FIRST  ONE  POSITIVE  AND  SECOND  ONE  NEGATIVE 

EIGVR»CAES(RR(X)  )  ’  ~~  “ . 

IP  (EIGVR.GE. 1,0” 10)  GO  TO  60 
If  (WI  (K)  )  40 , 2C,  40 
20  NRZEV-MHZEV* 1 

IF  (NaZEV.GT.  1>  GC  TO  30 
MR  (K)  * EIGVR 
GC  TO  80 

30  BR(K)»- EIGVR 

WRITE  (6.290) 

GO  TO  156 

40  NCEZEV =*NCPZEV ♦  1 

IP  (NCDZSV.GT.  1)  GO  TO  50 
a B  (X)  =»  EIGVR 
RR  (K+  1 )  *  EIGVR 
GC  TO  110 
50  WR(K)=-EIGVR 

HR  |K*1)  a-EIGVR 
aairs  j6x3oo> 

GC  TO  180 

60  IF  (NS (X) >  1u0,70,70 

70  IP  ('/I(Ki  110!8C'l10 

C- - EIGENVECTOR  ?0 3  SEil  2IGENV AID E, POSITIVE - 

80  IF  (NOB.  EC. 0)  GO  TO  100 

DO  90 

90  TCE(J,KP)*VF(J,X) 

100  KP»K?*1 

K=K«-1 
GO  TO  10 

c - EIGENVECTOR  FC3  COUPLE*  EIGEN V  ALUE, POSITIVE  REAL  PART - 

110  IP  (NOB. EC. 0)  GO  TC  130 
DO  120  J=1,3 
PR»VP  (J.K) 

PI=-VP  (J  ,*♦  1) 

TC3 (J,KP)*?3»FI 
120  TCEjJ,  KP*1)  *FH-FI 

130  KP*K?-»  2 

K»K*2 
GO  TO  10 

140  IP  (BI  (K)  )  180,150,  180 

c - EIGENVECTOR  PCR  REAL  EIGENV ALOE ,  NEG AT IV E  REAL  PART - 

150  CJKN)*BR(K) 

Cl  <KN)  »BI  JK) 

IF  (NOB.  NE.O)  GO  10  17'J 
KNS«KN ♦ N  S 
DO  160  J»1,H 

160  TCB  JJ  ,  KN  S)  *VP  |J,K) 

170  K1»KN*1 

K*S+1 
GO  TO  10 

C - EIGENVECTOR  PCR  CONPLEX  EIGEN V ALOE, NEGATIV E  REAL  PART - 

180  BS'BR (K) 

RI«Bt  (Ki. 

C(KN)»flfe 

C  (KHM)  «RB 

Cl  (KN)  »RI 

Cl  (KN»  1)  «-RI 

IP  (NOB.  NE.O)  GO  TO  230 

KNS'KN  *NS 

DO  190  J*1,N 
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M  H 


290  FOfiHAT  (IX, SIS  E01E8-LAGRANGE  ECUATICNS  HAV2  A  SEAL  21 3EH VALUE  A 
11UU  OS  ZEHO./) 

300  FORMAT  (1X.U9H  EUIE3-LAGRANGE  EQUATI  CHS  HAVE  A  COMPLEX  PAIR  OB  , 
iHEIGEHVAIUcS  At  06  NEAR  THE  J-C3EGA  AXIS.) 

EDO 


«0 
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>»SS33S1  jsa»»ss»=  - 


K33  ssassassas  33: 


SOBSOOTISE  HI  8  V  ( JSC  ,  A,  3  ,  C,  L ,  I!) 

IHELICIT  BEAL  *  8  (A-E.O-Z) 

DI HE  NS  10  8  A  (USC)  ,1  (N)  ,H  (8) 

DOUBLE  PBECISICN  A , C ,8IGA .HOLD 
NB-N-N 
D-1.  )D0 
NK  — V 

CO  ISO  K-1,3 
8  K  -NK* 8 
L(K)-K 
H  (K)  =K 
KK=SK*K 
BIGA-A  (KK) 

DC  20  j=k,:i 
IZ-N*  (J-1) 

DC  20  I-K, 8 
IJ-I2+I 

If  (DAES  (EIGA) -CAES  (A  (IJ)  ) )  10,20,20 

BIGA-A  (IJ) 

L  (K)  - 1 
a  Jk)  »j 
CONTINUE 

- 1 NTEBCHA8GE  HOWS - 

J»t  (K) 

IP  (J-  K)  50,50  ,30 

KI-K-N 

DO  40  1-1,8 

KI=RI*N 

HOLD »- A  (KIJ 

JI-KI-K*J 

A  (KI)  -A  (JI) 

a|ji)  =  hole 

- IJITE8CHANGE  CCLOSNS - 

I-H(K) 

IP  (I-K)  60,30  ,60 
JF-fi*  (1-1) 

DO  70  0*1,8 
JK=8K«-J 
JI-JP*  J 
HCLD=-A(JK1 
A  (JK)  -A J  JI) 

A  i JI)  -  HO LC 

- L - DIVIDE  CCLUHN  37  SINUS  PIVOT - 

- (VALOE  OF  PIVOT  SLSXS'IT  IS  CONTAINED  IN  3IGAI 

IP  (aiGA)  100,90,100 

D-O. 0D0 

HEIU3S 

DC  120  1-1,8 


UU  I  3U  i-  1,11 

IP  (I-K)  110,120,110 

IK=NK*I 

_ 

00  150  1*1,8 
IK-3K+I 
BOLD- A  (IK) 

IJ-I-M 

DC  150  J- 1,8 
IJ-IJ*  8 

IP  (I-K)  130,  150,  130 

IP  JJ-K)  140,150,140 
KJ* IJ- I ♦ K 

A  (IJl-HOID-A  (KJ)  *A  (IJ) 
CONTI8D E 

- 1 

KJ-K-N 

DO  170  J-1, 8 
KJ-KJ+ N 

I?  IJ-  K)  160.  170,160 
A  (KJ)  -  A  (KJ)  /BIGA 
CONTINUE 


—  BEDOCE  BAT  BIZ  - 


-DIVIDE  5CW  BT  FIVOT- 


D-C-BI5A 


-PBODOCT  OP  PIVOTS- 


A  (KK)  -  (1  .CDO)  /EIGA 


■HEPLACS  PIVOT  BT  RECIPROCAL- 
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r 


180 
C — 

190 

200 

210 


220 

230 

24  0 


250 

260 


coatruuE 


K*8 
K=  iK- 1  > 

I?  (K)  260,260,200 

I*l(K) 

IP  (X-K)  230,230,210 

JC=:!*(K-1) 

ja*H*jl-lj 

DO  220  J*  1, 8 

JK*JQf J 

HOLD* .4  (JK) 

JI*JH* j 
A  ( J  X )  =  -  A  <JI) 

A  (JI)  *HQLD 
j*«(k) 

IP  (J-X)  190,190,240 

KI*K-N 

DO  250  1*1,8 
KI*KI+  8 


-FINAL  BOH  AND  COLD 38  INTE3CHA8GE 


HCLD=4  (KI) 
J I=KI- X* J 
=-A  (2 
•  HOLD 


ilSi)*r--'-I) 


GO  TO 
K  =  'J 
BETU8N 
EN I 


190 
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II  AD-A144  159 INTERACTIVE  IMPLEMENTATION  OF  THE  OPTIMAL  SYSTEMS 
l|  CONTROL  DESIGN  PROGRAM  IOPTSYSX)  ON  THE  IBM  3033 ( U ) 

I  NAVAL  POSTGRADUATE  SCHOOL  MONTEREY  CA  J  G  HODEN  MAR  84 

F/G  9/2 


UNCLASSIFIED 


NL 


MICROCOPY  RESOLUTION  TEST  CHART 

NAllONAt  BUWl  Au  Of  STANDARD  1«H»<  A 


10 


20 


30 

40 

SO 

60 

70 

30 


90 


100 


110 

120 

130 


140 

150 

160 

170 


180 

190 


SUEBODTINE  SCCV  (M.,SL,WLI,VL1,VL2,NB,WF,ilRI.VB1,VH2, 

HESL*9  »H(!IL)  ,Vt2(Hl)  ,  8L  (NL.SL)  .  'ill  (NL.NL)  ,  X<.SL,NB)  ,u  (Hi.,  shi 
1  VB1  (MS)  ,  732  |.N5)  ,»K  IN  B  ,  NH)  ,  .  f I  (NS,  N B> 

BEAL*H  A.e.C, E,K1,K2,K3, K4 
DO  20  1*1, ;IL 
DC  20  J*  1.NB 
X  (I.J)  -=0. 

DO  20  11*1, SI 

X  (I,J)  =  XII,J)  *SLI  (I,  II)  *Q  (II,  J) 

DC  40  I*  1 ,  NL 
DO  40  J=  1  ,NB 

9  (i.j)  -o. 

DO  30  JJ-1.S3 

<I,J)  *X(I.JJ)  *881  (J,  JJ> 

1*1 

IF  (VL2 (I) )  60, 11C, 60 

IF  (1TB  2  ( J) )  30,90,30 
A*VL1  (I)  +  VR 1  (J) 

3=-2.*VL2  (I)  *VB2  <J) 

C=A**  2  *71.2(1)  **2*VH2(J)  **  2 
D*C**2-3**2 
K 1  =  A*C/D 

K2=-  (V 32  (J)  *C*  712  (I)  *B)  /D 
K3*-(iT32  (J)  *E  +  VI2  (I)  *C)  /D 
K4*-A*3/D 
11-1*1 
J1-J+1 

X  (I,J)  **  K1*Q  (I.J)  *K2  *Q  (I  ,  J1)  *K3*Q(I1  ,  J)  *K4  *Q  (II .  J  1) 

X  (I,J1)  *-K2*0  (I.J)  *K  1*9  (I.J1) -K4*Q(I  1,J)*K 3*0(11  ,J1) 

X  ri,J)  =-K3*0  (I.  J|  -<C4*0  (I.J  if  *K1*9(I  1,J|  *K2*0  II  ,  J1) 

X  (I  I.J  1)  **K4*9  (I.J)  -K3*0  (I ,  J  1  )  -K2*i  ( I  1 ,  J)  *K1*Q  (II,. I  1) 

J=J*2 
GO  TO  IOC 
A-VB1  (J)  *VL1  (I) 

B*A**2  *VI2 (I) **2 
K1-A/3 
K2 *V12  (I  )/9 

X  (I.J)  *K  1*0  (I.J)  -K2*C  (I*  1  ,J) 

X  (1*1,  J)  *R2*Q  (I.J)  *K1*Q  (1*1  ,  J) 

J*0+ 1 

IF  (J.IS.NH)  GC  TC  70 
1*1*2 
GO  TO  160 
J-1 

IF  (VR 2 ( J)  I  13C.140,  130 
A*VB1  (J)  *VL1  (I) 

E*A**2*VB2(J)  **2 
K1*A/B 
K2*VB2  (J)/B 

X(I,J)  *K1*Q(T,J)-K2*C(I,J*1) 

X  (I.J*  1)  *K2*Q  (I.J)  *K  1*Q  (I,J*1) 

J*J*2 
GC  TO  150 

X  (I.J)  *Q  (I.J)  /  (FBI  ( J ) *71.1  (I)  ) 

J*J*  1 

IF  (J.IB.NR)  GO  TC  120 
1*1*1 

IF  (I.  IE.NL)  GC  TC  50 
DO  170  1*1,  NL 
DO  170  J* 1 , N 8 
Q  (I.J)  *0. 

DO  170  II-l.NI 

g  (i.j)  *9  (i, J)  *8L(i,ii)*x  (u,  J) 

DO  190  1*1, NI 
DC  190  J  *  1, 3  B 
0  • 

JJ*1 , H  B 

*X  (I.J)  *Q  (I  ,J  J )  *8  B  (J,  JJ) 

DE 


MW8* 

m  a 

BETOBN 
INC 
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II 


onnnonrinnorinn 


*»»***  i*a*«as«aas«s«ss«assasssssji«aa  sxsaxssssassassaas  »=**  aasssass 

suaaoimsE  sods  (Hncbm.g  , snore, ns, ni  ,n2,iccn) 

WNOBB  T5 AMSPORHAIICH  MATRIX  0  CF  D-INV 

NS  NO.  OF  STATE  = 

8C  NO.  CF  ISEOTS  OP  OUTPUTS  = 

ICON  CONTROL  FLAG  TC  INDICATE  WHICH  T R ANS FOBS AT I OR  = 

0  *  MODAL  G  = 

1  *  MODAL  GARHA  * 

2  *  MODAL  H 

3  *  MODAL  C 

4  »  MODAL  K  * 

5  »  CONTROL  EIGENVECTOR  MATRIX 

6  *  MEASUREMENT  EIGENVECTOR  MATRIX 

ISX1SJ  SSS33  S33X3SS  S3S3X333%X33  3S333S3S333  333333333333333333  333T33  33353353 

ISFLICIT  FEAL*8  (i-H.C-Z) 

DIMENSION  WNOSB(NS,NS)  ,G(H1  ,N2)  ,  G  NOR  M  ( N  1 ,  N  2) 

CO  10  I*1,»1 
DO  10  J*1,N2 
10  G NORM  (I , J)=0. 

IECINT *  ICON ♦ 1 

GO  ro  (20,20,30,90,20,90,00),  IECINT 
20  DC  30  j*1,N2 

DO  30  1*1, as 
dc  30  k* i Ins 

30  GNORM  (I,  J)*GNCSB  (I.JWWNORM  (I  ,F)  *0(K  ,J) 

GC  TO  (40,70,30,90,80),  IEOINT 
40  WRITE  (6.170) 

50  CO  60  1*1. NS 

60  WBIT2  (6,230)  (GNCP.M  (I, J)  ,J*  1  ,N2) 

RETURN 

70  WHITE  (6,180) 

GO  TO  50 

30  WHITE  (6,240) 

GO  TO  50 

90  CC  100  J*  1,  NS 

DO  100  t*i,:ii 
DC  1G0  K* 1 , NS 

100  GNORM  (X  , J) *GSCBM  lI,J)-»G  IX  ,K)  *WNCRM(K,J) 

GOTO  (110.110,  11C, l‘0, tl6.  13C.14C),  I POINT 
110  WHITE  (6,190) 

GC  TO  T5C 

120  H  HITS  (6.200) 

GO  TO  15C 

130  WHITE  (6,210) 

GO  TO  ISC 

140  WHITE  (6 ,22n' 

ISO  DO  160  1*1. a  I 

160  warrs  (6,2 2o>  (s»cs«a,j)  ,j*i,ns> 

RETURN 

170  FOHMAT  (//, 5X , 45HECD AL  CCNT30I  DISTRIBUTION  MATRIX . TI*G..,//) 

180  FCBMAT  |//,5X , 5CKB0DAL  PROCESS  NOISE  OISTRIBOTION  MATRIX.  .. TI*GAE. 

190  F&^MAT  (//,5X,45HMCDAL  BEASUREBENT  SCALING  MATRIX. . .H(3AR)*T.. ,//) 

200  FORMAT  I// ,  5  X  ,  45  HT3E  MOD  AL  CO  STHOL  G  AINS . C*T..,//S 

210  FOBHAT  i//,5X,45fi CONTROL  EIGENVECTOR  MATRIX . C*M..,//) 

220  FORMAT  ( // , 5  X  ,  45 H BE A SURE  MENT  EIGENVECTOR  MATRIX . H (3AR)  *M . . , //) 

230  FORMAT  ( IX.  (2X  ,  1?60  14.6)  1 

240  FORMAT  (//,5X ,45b BCD AL  FILTER  STEADY  STATE  GAINS . TI*K..,//) 

EDO 


97 


uuuuuyuuouuyuuuuu 


r 


xasn  asxafaxxu x»««*<33»a**  ***** art****  ******** 

‘  soebootine  cnosh  imz.mT/VEC.ns.imbixe.nsq.ddd, Ji,o2.Jsoaa,aNoani,ii 

io,ca,Ni,  »2) 


as  (i) 

«r  (i) 

V  sc 
NS 

is  bite 

MNOSS 

smobhi 


SEAL  PART  OF  1-13  EIGE  NVALUE  » 

CCBFLEX  PART  OF  I-TH  EIGENVALUE  * 

SAT3IX  OF  3IGHX  EIGEN  V  ECCChS  STCa-i  E  IN  REA*  FOSE  ' 
FKCB  HQB2  r 

SO.  OF  STATES  * 

FIAG  TC  CONTROL  FOBKATS  FOa  DIFFER  ENT  EIGHENSISTESS* 


HOSniLZZED  XATBU  0  CP  RIGHT  EIGENVECTORS  STORED 

Q-INV ESSE  ^2*C0NGUGATE^0F  LEFT  EIGENVECTORS 
STORED  81  308  IN  REAL  FOBS 
NSQ.EGD, D1.E2  -  ABGUHSSTS  PASSED  70  ,1INV 

»;*SiM*=*i=  =  ==  =  *===  »=*=  =  »*«====  *-=“:,=s'!:'“::!1,a*3'3!  =  :!'*,r=**=** 


c - 


10 

20 


30 


40 

50 

C~ 


6Q 

IS 

90 

100 

110 

120 


KK=0 
LB=0 

EC*50  K  =  1  #NS 

IF  }dABS5{3t\kU  .LT.UD- 10)  GO  10  50 
LC=LC»  1 
E8AX=0. DO 
DO  20  1  =  1, NS 

CBC0-7EC  (f,X)  **2+VEC  U.K*  1)  «•* 

IP  (CBOD-EBAX)  20 ,1  0 ,10 
E8AX*C30C 

a=x 

CONTINOE 
V  HE= V2C  (fl  ,K) 

V8I=V5C  (B,X*1) 

CO  30  1=1, NS 
VB-VEC  (I  , K) 

VI=VE C  (I,R*1) 

7BC3N= (VH*VB8*VI*VBI)/EBAX 
VECIN=]'VB*Vai*VI»VBB)/£BAX 

H»oaa  <r,s)=vEcs» 

HHOBB  (I,K»1)  =  V  EC  I N 

CONTINUE 

KK*1  , 

GO  TO  50 
KK«0 

_ 2H5cSBALIZE  BEAL  EIGENVECTORS  Bit  TSE  TOTAL  LENGTH - 

DC  90  K*  1,NS 

IP  (DABS  IMY  (K)  )  .GE.  1  .0-10)  GO  TO  30 

LS-LB+ 1 

BeBOD*0.C0 

DO  60  1=1, NS 

BESOD*  VEC  It,  K)  **2  *82  SOD 

B80D=DSQBT  (2  HBOC) 

DO  70  1  =  1, :1s  _  _ 

8VEC=VEC  (I,  K>  /B8CC 

MNQ8H(I,K)*BVEC 

CONTINUE 

GO^TO  { 9C  .  10  C, 110,120,130),  IBFITE 
HfilTB  {6,320) 

GO  TO 

MBIT2  (6,330) 

GO  TO  14  £  „ 

MBITS  (6.340) 

GO  TO  14C 
MBITS  (6.350) 
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GC  73  140 
WHITE  (6  ,360) 
KK=0 
NPSTW*0 
NFBTW*  1 
DO  180  1=1, NS 


UU  X  —  1  §  U 

II  (KK.EC.l)  SC  TC  170 

IF  (DABS  (fc?(I) 1.31. 1.C-10I  KK=1 

BIST  OUT  NO  SORE  THAN  6  WORDS,  SOT  3 2? A 3 ATISG 

IF  (NP9TK.LT. 5. OH.  (NFRTW.  2Q.  5.  JND.KK  . EC.Q)  )  GC 

FBT  (HFST W  +  1 )  =RIGHT 

WRITS  (6,F3T!  (S7CSF.  (J)  ,  J*1,  N££T») 

NPRTW=0 


SOT  3  2?  A  3  ATISG  CON? LEX  21  GY AL - 

ND. KK .EC.Q) )  GC  TO  150 


NPRTW=0 
NF2TW=  1 
NPRTW»NPRTW* 1 
NFBTW*  NFBTW*  1 


IF  ]KK.2C.1)  GC  TC  160 
STCHE(NPFTW5  =WZ  (I) 

FBT  <SF3TW)=PIELD 
NFBTW* NFBTW* 1 
FBT  (NF ST  W)  =SE  BCOL 
GC  TO  180 
STOBE  f  NPHTW)  =W2  (I) 

FHT  (NP.NT W)  =  PI EIC 
FBTfNF  STi*1)  =CC3SA 
STOBE  (  NP ETW*  1 )  *BY  (I) 

FBT (HFBTV+2) *FIEIC 
FBT  (NFBTW *3)  *SEBCCL 
NFBTW* NFBTW+3 
N  E5TW*  NP  BTW  ♦  1 
GO  TO  18C 
KK=0 

CONTIS  UE 

FBT  (NPBTS)  =S EB  EH  C 

FBT  fMFBTS+1)  =a:GHT 

WHITS  (b.ESt)  ISTC3E  (0)  ,  J  =  1  ,NP?TW) 

IF  (I SF.I  T2 .  N £  .  i  J  GO  TO  140 
WHITE  (6,370) 

GO  TO  20C 
WHITE  (6,390) 

CALL  5AP8NT  {NS, NS, NS, 6  ,  S  SO  SB,  4,  '  (6  (  IX,  )PD13.6))  •) 

GOTO  (230,21c, *10, 2 20, 220) ,  haiTS 
CALL  .1 CD2  (S  NOBS ,BQ ,  CS,  NS,S1,N2,5) 

GO  TO  23  C 

CALL  3CDE  (W  NC  £9  ,  HO,CS,  NS  ,N  1  ,  Ji  2 , 6) 

GOTO  (24C-250,26C,570,280) .  IWBIT2 
WHITE  (6,390) 

GO  TO  29C 
WBITE  (6,400) 

GO  TO  29* 

WHITE  (6,410) 

GO  TO  290 
WHITE  (6,420) 

GO  TO  29C 
WHITE  (6,430) 

- SAVE  U-INY2BSE  CEEN  LOOP  IN  WN0R3I - 

I?  (IWBITI  .GT.  1)  GC  TO  310 
DO  300  1*1, NS 
DO  300  J*  1, NS 
WNOBHI  (I  ,J)  -WNCFfl  (I  ,C) 

CALL  BIN*  (NS C ,W NOBS I,SS  ,  DOD ,  C 1 , 02) 

CALL  P.  A  P  3  NT  (N S ,  NS ,  NS ,6  ,  W  NO BBI,«  ,  •  (6  ( 1 X ,  1PD1  3.  6)  )  • ) 

HETUaN 

CALL  BINY  JNSC.SNCHS.NS ,DDD, 51, D2) 

CALL  RAPfiBT  (NS,  SS, NS, 5 ,  WNORfi  , 6,  •  (6  (  IX,  1PD1 3 .6) )  ') 

RE  ISBN 

POSNAT  (//I  X,  4  2HOIEN  LOOP  EIGENVALUES . 7  .  D  £t7  SI- 

PCHBAT  //IX, 46HC-LC0P  OPTISAL  BEG.  H-VALOES. . .DET  SI-?*G»C) . . ,//) 
FORBAT  //IX, 46HC-I0CP  SD30PT.  BEG.  E-YALUES. . . OET  SI- P*G*C| • . ,//) 
FO  HB  AT  //IX,  46HC-LCCP  OPTIBAI  EST.  E-Y  ALU  ES  .  .  .  OET  SI-P*K*H)  .  .  ,//) 
FORBAT  //IX,  468C-LOCP  SUBOPT.  EST.  E- VALUES. . .OET  SI- ?♦ K* H)  . .  , // 

FORBAT  //I  X,  46UCIEN  LOOP  RIGHT  2IG  2  NY  ECTOB  SATRIX . T....,//{ 

FCSflAT  //IX,  46BC-L0CP  RIGHT  JIGENV2  CTOS  SATRIX . a.  ...,//) 

FORBAT  //I  X,  46HCEEN  LOO?  LEFT  EIGEN  7ECT03  SATRIX . T-IN  V , . , //) 

FOHBAT  //IX, 46BC-LCC?  OPT.  REG.  LEFT  E-VECTOR  SATRIX. .S-INV. . ,//) 


i 


#10 

420 

430 


rcaair 

poasAi 

FCSniT 

'niA 


(//IX,  46HC-L0C?  SUBOPT-aEG.  Lc?T  E-VECT03  MAT3IX..M 
(//1X,46HC-ICCP  OPT.  PI  IT  S3  LEFT  S-VSCT08  MATRIX. .« 
(//IX,  5  1HC- LOOP  SUBOPT.  FILT3 a  LEPT  £- RECTOS  HATBIX 


^s«aa*ss333s»sssss«sc  tasssxssasasszssssBasxsassisnssaaztzssrss  sssszssa 

SliBSOUTI  HE  T?  ( 8 .  S  I! ,  3SQ  ,  A ,  A  A,  B  ,  3  .  BH ,  L ,  C ,  CB , 1 FD  F«  .  D , 3B ,  CC ,  C  P , 

I  E va  ,EVI.Pa,*I,SC,JCF,aES  ,01,32, DDD, EPS, IT  F, itfxi 
IMPLICIT  8EAL*6  (A-H,C-Z1 

DIMENSION  A  (.V  ,  3j_  ,AA  (8.8)  ,S(  8,  !),3S(H,a)  ,C  (I,  8)  ,CM  (L,S)  ,D  (L,3)  ,33  (N 

II  ,CC(H)  ,CE  (3)  ,  Eva  |ti)  ,EVI  (8)  ,  PS  IS)  ,?I  (3)  ,SC  (V ,3)  ,  JCF  ( 8)  ,BE3  (8)  , D  1  (8 

-SAFE'cO^pIjTAIION  CN  CL  *80  CL  SYS  3ITH  BCEJL  90 3K  DONE  18  OPTSYS - 

-  -  --  TO  50 

TO  10 

AA.i, 3.L,C,?H,?I, D 1,02, JCF, SC) 
flCCAL  SAIBI CIS  FOB  BFSIDU2S - 


<io" 

20 


30 


40 

50 


60 


IIIOS  CN  CL 
.10.  1)  GO 

.20.  2)  GO 
ES  (8, SR, A.) 


T A1IO 8 
IF  (IT  FX  .IQ. 

IF  (IT  FX  .2' 

CALL  POLES 

- COilf  GIE 

DO  20  1*1,3 
DO  20  0*1 ,3 
AA  (1, 01  *SC(I,0) 

DO  30  I* 1  ,L 
DC  30  0*1,3 
CB  (1,0)  *C.DO 
DC  30  k*1,3 

CB  (1,0)  *CE  (1,0)  *C  (I,K1  *4  A  |K,0) 

CALL  YI3V  (3SQ,A*,3,£DD,0  1,02) 

DO  40  1*1,3 
DO  40  0*1, a 
EB  (1,0)  *0. DO 
DO  40  K*  1 , 3 

BB^IjO^Efld.O)  ♦AAd.K)  *3  (8,0) 

DO  60  1=1,3 
DO  60  0=1, L 

IF  (ITE  .NE.  3)  CALL  2E30S  ( 1 ,0  ,I?0P  8 , 8 , 3S ,  A ,  A  A  ,  B ,  3  ,  L,  C,  0  ,  EB  ,CC ,  CP 
1,EVP.,EVI,C1,D2,£PS) 

IF  (IT?  TnE.  2)  CJLL 
C03TI NOE 
BETOEN 
END 


2)  C  ALL  BES  ID  ( 1 ,0,8 ,  JC  P , H ,3B  ,  L  ,C3 , PB,  PI,  3ES  ,  3B  ,CC  ,  1) 
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C*a  M«3n3s3ss3333ssxi33s3nx3a«xa3s»tsxs3aiiasaa«asis3itszs«:3 

SU3SOOHSH  POLES  IN,S»,  a,  AA,  2,E,L,C,  EVB,2VI,  D1,D2,JCF,  SC) 

I J!  FLIC  XT  BEAL*  8  (A*H  C—il  »  r  r  r 

OiaENSIOS  A(B.B)  ,Aa'(N,h{  ,B<B,8),C<L,  B>  .  EVH  (M>  ,SVI(N)  ,31(:i) 
iC?  / Sr?  #  5C  ( •  w / 

co  10  t*i,a 

DO  10  J*1,B 
10  AA  (I,J)  =A  fi,J) 

CALL  B  A  LI  tiC  ( N  H  ,  II  ,A  I  ,L08  ,  IU IG  F  ,  D 1 ) 

CALL  OBTHES  ( H 8 ,  N  ,10 8, X HIGH ,  A  A  ,  Q2j 
CALL  OBTBAN  j  BE  ,.N  ,LO  8,1  H  I GH  ,  A  A  ,32  ,SC  ) 

CALL  HCB2  (H3,8,L08,  I HIG  H  ,A  A  ,  £  V 8 , 271  ,SC  ,  I2SB) 

IF  (I23P.  -BE.  C)  GC  TO  30 

CALI  3  ALEAK  (.78,  S,L03,IHIGH,  D  1,N,5C) 

881X2  (b.40) 

DC  20  1=1.  H 

20  88X72  (6,50)  E  78  (I)  ,  571  (I) 

8ETUPN 

30  8HII2  (5,60) 

BETOBN 

C - 

40 
50 
60 


FCB8AT 

FOHHAI 

FCHHAT 

SBC 


(///,29a  TF  CEilOBLBATOR  EIGEH  VALUES:,/) 
j/,2X,3H  (-F13.6  .-ill)  *J  (,?  13.  6,  IB)  ) 

(35H  EALLUBE  IB  HQ 32 ,  CALCULATING  POLES) 


»D2  (il)  ,J 
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^sasass »i=33 sax s ss sas as s  ass 


10 

20 


SUEHOUTINE  CCCMP  (N.SS.A.C.C 
REAL*#  A,C,CC 

DIEE1ISI0S  i(tia.S)  ,C(S),CC(H) 
DO  10  1*1, X 
CC  (X)  *0. 

DO  10  J*1.H 

CC  (X)  *CC  It)  *C  (J)  *1  (J  ,1) 

do  20  i=i,n 
cm=ccin 
REHJ2M 
ESC 


38S««SS3  sssssssssasssssass  SS 

:c) 
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SUBROUTINE  RE  SID  (K  1  ,K2  .  N  ,  JCF  ,  M,  33,  L  ,  CM  ,  ?  5  ,  ?  1 ,  R  S3 ,  33.CC,  IT  7) 
IMPLICIT  BEAL  +  8  (A-H.C-C) 

DIMENSION  JC?  <S>  ,EM(N,3)  ,CS(L,S)  ,?R(  N)  ,FI(N|  ,JSS  (N)  ,3S  (N)  ,CC  (N)  ,PS 

^llA  SN/8K*S IN  (B*T/, 9 1/8H  */,  3  2/832  XP  ( A*T)  /  ,  2D/1  H)  / 

DATA  ZESC/O.  D  0/ ,  T  1/4H*T  «  • /,  BLAAK/HH  /, C3/3H*C0S (B«T/ 

C - TEMPORARY  MOD  Tilt  JCE  15  CALCULATED - 

DO  10  1  =  1,  il 
10  JCE  (I)  =0 

C - TEMPORARY  MCE - 

IP  (IPT  .  EQ.  1)  3  FIT  E  (6  ,  170) 

DO  20  I *1.8 
EE  (I)  =  EM  (1.S1) 

20  CC  (I)  =CM  <K2,I) 

C - LOOP  TH30 UG H  THE  POLES - 

1=0 

30  1=1+1 

IF  IT  .31.  SI  GO  TO  160 

IF  (JCF(I)  Aq.  1)  GC  TO  60 

IF  (0A3S  (PI  (I))  .LI.  1.D-1Q)  GC  TO  50 

C - COMPUTE  SIMPLE  COMPLEX  POLE  RESIDUES  AND  PRIST  BOTt! - 

RES  (I)  =CC  (I)  *SE  II)  +  CC  (1+  1 )  »BB  11+  1) 

BES  (1+1)  =CC(I)  *EE  (1+  1)-CC  11+1  )  *B3  (I) 

IF  (IPT  .EQ.  0)  GC  TC  40 
PST  (1)  =S  LANK 
P  BT  ( 21  =  R  2 

IF  l?I(I)  .  EQ  .  0  .TO)  PST  (2)  =  S  IAN  K 
p BT  (3)  =CS 
PHI  M  =RC 

KBITS  (6,180)  ES(I)  ,  PI(  I)  ,  RES  (I)  ,  (PS  T  (J)  ,  J=1  ,6) 

1=1*1 
PBT  (3)  =  SN 

KBITS  (6,130)  PS  (I)  ,  PI  (I  )  ,8ES  (I),  (PRT(J),J=1,4) 

GO  TO  30 
40  1=1+1 

GC  TO  30 
50  CONTINUE 

C - COMPUTE  SIMPLE  HEAL  POLE  SESIDUS - 

B2S(I)  =CC  (I)  *EE  (I) 

IF  (IPT  ,zQ.  0)  GC  TO  30 

PRT  <  1)  =31 

PHI  (2)  =R2 

PBT  (31  =  BLANK 

PRT  (4)  =  8LA.NK 

BHITE  (6,180)  PR  (I)  ,?I(I)  ,HES  (I)  ,  (PST(J)  ,J=t  ,4) 

GO  TO  3  0 

C - LOOK  AHEAD  TC  DETERMINE  SIZE  OF  THE  JORDAN  3 LOCK - 

60  K  =  1 

KT=»-I 

DO  70  J=I.KT 

IF  (JCF  ( J)  .  EQ.  0)  GC  TO  80 
70  K=K+ 1 

80  CONTINUE 

IF  (DA  BS  (PI  (I )  )  .IT.  1.0-70)  GC  TO  110 

C - COMPOTE  REPEATED  COMPLEX  POLE  AND  PRINT  OUT  ALL  FOUR - 

K  =  1 

BES  (I)  =CC  (I)  *EE  (II  +CC(I+  1)  *BB  (1+  1)  +C  C  (1  +  2)  *3  3  (1+2)  +CC  (1+  3)  »3 B  (1+  3) 
RES  (1+1)  *CC  (I)  *BB  (1+1)  -CC  (1+1)  *B3(I>  +CC  (1*2)  »3B  (I  +3)  -CC  (1  +  3)  *6B  (1  + 

RES  (1+2)  =CC  (I)  »SB  (I+31  +  CC  (1+1)  *BB  (1+  2) 

RES  (1+3)  *CC(lS  *BS  (I  +  3I-CC  (I  +  1)*BB  (1+2) 

IF  (IPT  .EQ.  0)  GC  TO  100 
PHI  ( 1)  =91 
PET  (2)  =R 2 

IF  (DABS  (PR  (I)  )  .GT.  1.D-10)  GC  TO  9  0 

PRT  (1)  =ELANK 
PRT  (2)  =B  LANK 


PRT  (3)  =CS 
PRT  (4)  «ED 

BBITE  (6,180)  PR(I)  ,PI(I)  ,R3S  (I)  ,  (PRT(J)  ,J=1  ,4) 
PRT  (3)  =SN 
1=1  +  1 

WRITE  (6.180)  PR  (I)  ,  PI  (I)  ,  3ES  (I)  ,  (PRT(J)  ,  J=1 ,4) 

pbt  ( i)  =ri 
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IF  (DABS  (P3  (I)  )  .IT.  1-0-10)  r  RT  ( 2)  *  BLA  UK 
PST  (3)  =CS 
1*1*1 


100 

c — 
in 


120 

130 


1UO 

150 

160 

170" 

ISO 

190 


HR  ITS  (6.190)  P3  (I)  ,EI(I)  ,BES  (I)  ,PST  (1)  ,K,  |?BT  (J)  ,J*2,4) 

PBT  (3)  =S  H 
1*1*  t 

MBITS  (6,190)  PB  (I)  ,EI(I)  ,BSS  (I)  ,PRT  (1)  ,K,  (PBT(J)  ,J*2,4) 

SC  TO  30 
1*1*3 
GC  TO  30 

-COKPUTS  DEFEATED  HEAL  POLE  aESIC'JE  AND  PBIHT  OOT  ALL  X  OP  THEN - 

COSTIHUE 

KT*I*K-1 

HH=0 

DO  130  J*I , ST 
HB*NN* 1 
BES(J)  *ZEBO 
DO  12J  JJ=«J,XT 

BSS(J)  *H  ES  (J )  *  E3  (JJ)  »CC  (JJ-HH  +  1) 

CONTINUE 

IP  (I? T  -EQ.  0)  GC  TC  150 
N»*(J 

PRI  1)  =T1 
PBT  2)  =  B2 
PBI  3) =BLASK 
PBT  (4)  *  GLASS 
DO  140  J*I.XT 

KBITS  (6,190)  ?3  ( J)  ,  PI  ( J )  ,2ES  (0)  ,?RT  (1)  ,  N!i ,  (PET  ( J  J)  , JJ*2 ,4 ) 

HIUNM* 1 
GC  TO  30 
I*KT 

GO  TO  30 
CO  HUM  US 
5ET0BH 


1 2 AS , A 1 ) 
ESC 
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Q saisaisaesxti 


SUEBO'JTINI  3ALANC  ( N M.N ,  1  .LOW  ,  IGb ,SC  ALE) 
IN TEGS 3  I.J ,K .L.S.N, JJ, NH.IGH  .LCW.IEXC 
BEAL*8  A  <aa,N)  Jcki  (W 
BEAL*8  C.F,G,R,S.£2,  SADI I 
SI AL*8  0il5 
LOGICAL  NCCONV 

DATA  3 ADIX/Z4  2  130000 COO 00 000/ 


■****3*33 3333  333  s  333333x3 


c— 

10 


20 


30 

40 

c~ 

50 

60 


70 


32*NAU IX*SADIX 

K*1 

L*N 

GO  TO  60 

- IS-LISI  E ECC ICO  S E  ?OH  BOW  AN  E  COLUSS  EXCHANGE - 

SCALE (81*J 

If  (J  .SC.  SI  GO  TC  40 
DO  20  1*1, L 
P*  A  II,  J) 

iJiij)  :i,x'a> 

CONTIS  OE 
DC  30  I«K,N 

cdirfiliUE 

GO  TO  (5 C ,00)  ,  T £  1C 

-SEABCH  tea  SOSS  ISOLATING  AS  EIGENVALUE  AND  PUSH  TH EH  DOWN - 

If  (L  .EC.  1)  GO  TO  230 
l*L-1 
DO  80  JJ 
J*L*1-JJ 
00  70  1*1, L 


t.L 


If  (I  .  EC.  J)  GC  TO  70 

IP  (A(J.I)  .HE.  0.03C)  GO  TO  ao 

CCN-fllJoi 


80 


C - 

9  U 
100 


110 


120 
C - 

130 
C - 

mo 


150 
C - 


160 


170 

180 


GC  TO  110 

O.ODG)  GO  TO  120 


8-L 
IEXC* 1 
GO  TO  10 
CONTINUE 
GO  TO  100 

— SEASCH  fOH  CCLU3NS  ISOLATING  AN  EIGENVALUE  AND  PUSH  THEN  LEFT-* 

K»K*1 

DO  120  J*K,L 
DO  1)0  I *X,L 
If  (I  .EC.  J)  GC 
If  jA  (I.J)  .NE. 

CONTINUE 
H*K 

IEXC*2 
GO  TO  10 
CONTINUE 

- SOB  BALANCE  THE  SUEKATEIX  IN  BOWS  K  TO  L- 

DO  130  I*K,L 
SCALE  (I)  *1.000 

- IT! BATIVE  LOOP  POH  N0R8  SEDUCTION - 

HOCONV*. PALSE . 

DO  220  I*K,L 
C*0.0D0 
H*0. 0  DO 
DO  150  J*K,L 
IP  (J  .EC.  I)  GO  TO  150 
C*C*DABS  (A(J,I)) 

H*B+DAES  (A  (I.  J)  ) 

CONTINUE 

- GUABC  AGAINST  ZEHO  C  OR  3 

If  (C  .EC.  0. COO  .CB.  B  . EQ 
G*H/3A  EIX 
P*1 .000 
S*C*B 

If  JC  .GE.  G)  GO  TC  170 
P*F*BACIX 
C«C*B2 
GC  TO  160 
G*B*RADI  1 

If  (C  .LT.  G)  GO  TO  190 


DOE  TO  UNDE BPLOH - 

O.ODO)  GO  TO  220 
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?«  F/ 3 A  CIA 
C»C/32 
GC  70  180 


190 

IP  (1C  ♦  6)  /  f  .C-E. 
G*1 .000/? 

SCiL2(Ii  *SCALE  (I) *P 

NCCON  V  3 . 1 3  UE  . 

EC  200 

200 

fcPnVW8 

210 

220 

cdsft!ias  <J'I>  *F 

230 

IP  (NOCONV)  GC  TO  1«0 
iCW«K 

IGH»L 

filTOBM 

END 

- NOW  EALAHCE - 

0.9 5  CO  *  S)  GO  TO  220 
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S  0  ERCOTI N  E  OST  EES  ( NS,N  ,  LCV  ,IGH,.\,C31) 

I NT5GE  7  I.  J,1, 8,11,0.2,  LA  ,  BP,  8  B.IGH.KPI,  LOW 
REALM  A{<B.s/,lIaT(XGS> 

8IAL»9  F,G,H, SCALE 
REALM  OSCHT,  CAES.CSIG.V 
LA-isa-i 
RE  1*  LO '4  ♦  I 

IP  (LA  .LI.  X  p 1 )  GO  10  1 Q  0 

DC  "JO  1* KF 1 ,  LA 

B»0.000 

CST(M)  *0.000 

SCALZ’C. CCO 

- SCALE  COLUMN  (ALGOL  10L  THEN  NOT  NEEDED) 

DO  10  I«S,IGH 

SCALZ*SCAtS*CAES (A (1,1-  1)  ) 

IF  (SCALE  .3Q.  C.OCO)  GO  TO  90 

ai*i*tGH 

DO  20  II*B,IGa 

i«bp-ii 

OST (if =A (1,3-1) /SC ALE 
H=*ri+08T  ( I)  *031  (I) 

CONTINUE 

G*-DSIG!J  (CSQET  (H)  ,ORT  (5)  ) 

H»H-08T  (S1«G 
OBT  (S)  *OET  (B)  -G 

- FOSS  (I -  (  0*UT)  /H  )  *  A - 

CO  50  J*H,N 
F«>)  .000 

DO  30  Ilan.ZGH 
I*3P-II 

P*F*OaT(I)*A  (I  ,J) 

CCSTINUi 

P-P/H 

UC  40  I»H,IGH 
A  (I.JJ  -A  (I, J)  -P*CET  (I) 

CONflUUE 

- FCBB  (I  -  (U*(JT)  /H)  *A*  (I-  (U*OT)/H) - 

DC  30  Ia  1 ,  IGH 
F*C.  JDO 

DC  60  0.2*11. IGH 
J*«P-JJ 

P-F40HT(J)*A(I,J) 
contin ae 

P=F/H 

DO  70  J»B,IGH 

OHT(M)  *SCAL2*CET (fl) 

AJB.M-  1)  =SCALE*G 

CONTINUE 

HEIUIiN 

ENC 


(]33i3X«3*sss  -S33S33  s  s  s  s  s  ss  s  =as.s  ac  a  sis  x  sassxMxssaaaaa 

SOEHOOTINE  QBTBAN  < N  K,  :i ,  LCS  ,  IGH.  A  ,OR  T ,  2) 
integeh  i,J,;J,Ki,2s,:ipr  an.ir.H  ,icw,!!p i 
BEAL*3  A  (SS.IGS)  ,C2T  (IGH)  ,Z(NS,N) 

REAL’S  G 

C - INITIALIZE  Z  TO  IDENTITY  HATBIX - 

DO  20  1*1,3 
DO  10  J*1.S 
Z  (I,JJ  =g.CD0 
Z  (1,1)  *1.0D0 
CONTINUE 
KL*IGH-LC«-1 
IP  (KL  .11.  1) 

DO  70  Sa*1,iCL 
HP*IGU-«S 
IP  (A(3P,aP-1) 

■NF1*NP*1 
DC  30  I*flp 1 , IGH 
OHT(I)  *A  (I,a?-1) 

DC  SO  J  =  KF, IGH 
G*0. OD  0 

DC  40  I*SP,IGH 
40  G*G*08T(I)«Z(I,J) 

C - DIVISOR  BELOB  IS  NEGATI72  OF  H  FOBBED  IN 

C - DOUBLE  DIVISION  AVOIDS  POSSIBLE  UtfQEHFLO 

G*  (G  /  OBTOP)  )/A(SF,:iP-H 
DO  50  I*KE,IGH 
Z  (I.JJ  =Z  (I,J)  *0*021  (  I) 

CONTI !:  02 
CONTINUE 
HETU31I 
END 


ISS3IE2  3 


10 

20 


30 


50 

60 

70 

30 


,C  TO  30 


.  EC*  O.ODO)  GO  TO  70 


^  0P.CH2S  , 
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c  3a>«sax3:asiuz7X3SX3*2isufl4  sxaaaaissssa  sassssssss ssssssss  ssss  ssssss  =s 

SOEBOOTISE  HQ  3  2  ( SN  ,  N  ,L0  H  ,IG  H  ,  H ,  HR ,  i  I ,  Z  r  1253) 

INT2GEB  I,J,n ,1,3,3, EN, II  ,JJ  ,  LI, 33,  HA,  li  tl ,  :i;.,  IGU,  ITS  ,  ’-OH ,  .IP  2 , 2NS2  ,1 

1  EBB 

SEAL'S  H  (»H,N>  ,B8(N)  ,  KI  (  M)  ,  2  (NH,  :l) 

BEAL'S  ?,Q,3  ,3  .1  ,  ii  ,  X  ,  7 , 8  A  .3  A  ,  VI, 7  8,2  2,  NCSS,  .1  ACHE? 

SEAL'S  CSC3T, LXti.tsiGS 
INTEGER  HI HO 
LOGICAL  SCTLAS 
COMPLEX  *1623 
CC3PL2X  '  16  DC3PLX 
REAL’S  0 REAL , 0X3  \G 

C - STATE3E.IT  FUNCTIONS  EH  A  3  L  E  EXTRACTION  OF  SEAL  AND  I3AGISAST-- 

c - PASTS  OP  DCOELE  PRECISION  CC3PLEX  NUMBERS - 

DBEAL  (23)  =23 

DI3AG (ZJ) »(0. ODC.-1.ODO) *23 
DATA  MACEIP/Z341CCCOCOOOCCOQO/ 

I£83*0 
NOBM'O. JCO 
K*  1 

C - STORE  5 COTS  ISOLATED  3Y  3ALANC  AND  C03PUT2  MATRIX  SO BH - 

DO  20  I»1,S 
DC  10  J  =  K,H 

10  N08S-N0BB+DABS  (H  (I,  J) ) 

IP  (I  .GE.  LOti  .AND.  I  .  LE.  IGH)  GQ  TO  20 
SB  (I)  =  H  (1,1) 

BI  (I)  =  C.  CDO 
20  CONTINUE 

SN  =  IGH 
T’O.ODO 

C - SEARCH  FOB  NEXT  EIGENVALUES - 

30  IF  (EH  .IT.  LOW)  GO  TO  290 

I T  S  =0 
NA=£N-  1 
EH32*NA-1 

c - LOOK  POB  SINGLE  SHALL  SUB-DIAGONAL  ELEMENT - 

40  DO  SO  LL»LO'4,EN 

L»ES*LO«-LL 

IF  (L  .EQ.  LOS)  GC  TC  60 
S=0ABS  (  H  ( L-  1  ,  L  -  1 )  )+CAB3(H(L,D) 

IF  (S  .EQ.  O.OCC)  S'SOBH 

IF  {DABS  (H  (L ,  L-  1)  )  .LE.  NACHEP  *  S)  GO  TO  60 
50  CONTINUE 

c - FORM  SHIFT - 

60  X*H  (EN  ,SN) 

IF  (L  .EC-  EN)  GO  TO  220 
T=H  (NA  ,NA) 

H»H(ES,NA)  *H(H».EN) 

IP  (L  -EC-  NA)  GO  TO  230 
IF  (ITS  .EO.  30)  GO  TO  500 

IP  (ITS  .NE.  1C  .AND.  ITS  .NS.  20)  GC  TC  90 

C - FCBH  EXCEPTIONAL  SHIFT - 

T*T+X 

DO  70  I=LOa,EH 
70  H  (1,1)  =H  11,11  -I 

S  =  CABS  (H  (  EN ,  N  A) )  ♦  CAES(H(NA,2NM2)  ) 

X«0.75D0*S 

T’X 

B*-Q.4  3  75DQ*  S*S 
80  ITS'ITS*  1 

C - LOCK  FOB  TSO  CONSECUTIVE  SEALL  SOB-DIAGONAL  ELEHENTS. - 

DO  90  3fl»l,ENH2 
H*EN32 ♦L-HH 
ZZ'H (3,3) 

R  »  X-  ZZ 
S»E-ZZ 

P»(8  *  S  -  B) /H  (8*1  ,  H)  ♦  H  (B,  S'  1) 

g-8(M*  i,a*ii -zz-a-s 
a»H  a*2,a*i 

S-CABS  (P)  'DABS  (Q)  *CAES(8) 

P-P/S 

ilYA 

IF  (fl  .EC.  L)  GO  TO  100 

IP  (DABS  (H  (it,  8-1)  )  *  (DABS  (Q)  ♦  DABS  (B)  )  .LE.  3ACHEP  »  DAB3(P) 
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1  *  (DABS  (H  (B- 1  ,B-1)  )  ♦  DABS  (Z2)  ♦  DA  ES  ( B  ( S*  1 ,  B  ♦  1 )  ))  )  GO  TO  100 
90  CONTINUE 
ICO  BP  2*3+  2 

DC  113  I=BP2,2N 
8 (I,I-2f*C.ODO 
X#  (I  .iC.  a P  2 )  GC  TO  110 
H  (X .  E-  3)  *0.300 
110  CONTINUE 

C - DOUBLE  C8  STEP  INVOLVING  SCSIS  L  TO  EH  AND  COLUBNS  B  TO  EM - 

DC  210  K=S,NA 
SCILA3*K.NE.NA 
IP  (K  .EC.  B)  GO  TO  120 
p *h  Ik,  k- T> 

C*H  (K*  1.X-1) 

a-c.ooo 

IP  (NOTLAS)  a«B(K*2,K-1) 

X*0A35  (?)  *OkBS  JC)  ♦CALS  (B) 

IP  (X  .EC.  0.3IGS  GO  TO  210 
P-P/X 

r.r/x 

120  s»csign(cscht  (E*p-*g«c*!!*a)  ,pi 
IF  (K  .sc.  B)  GC  10  130 
H  (K,K-  1)  =  -S*X 
GO  TO  1U  C 

130  IP  (L  .HE.  3)  8<K,K-  1)=-H  (K,  It-  1) 

140  P*P*S 
X*F/S 
X*Q/S 

zz*a/s 
Q  *C/P 
H=  E/P 

c - ac«  aociricATics - 

DC  163  J*K.N 

P*H  (K,  J)  +C»H  f  K*  1  ,3) 

IP  (.MCT.  HOT  LAS)  GO  TO  150 
P*P+(»*H (K+2.J) 

H  (K»2, J)  =  H(K^,JI  -P*ZZ 
150  H  (K*1,  J)  *H  (K>  1  ,J) -P*T 
H  (K,J)  *H  |K,J)  -f*X 
160  CONTINUE 

J*BIN0  ( EN ,K  +3 ) 

C - - - - - COLD  BN  BCEIPICATIO  N - 

DO  180  1*1, J 
F*X*H<r.K)  ♦?*«  (I.K*  7) 

IP  (.NOT.  NOTLAS)  GO  TO  170 
P=*P*ZZ*H  <I,K*2) 

H  (I,K>  2)  *H  <Z  ,  K  +  2)  -P*8 
170  H(I,K*1)  *H(I,K*1)  -S*Q 

180 

C - - - ACCUMULATE  TEA  MSP  OHS  All  ON  S - 

DO  200  I*LOW , IGH 
P»X*Z  (I,  K)  ♦  X*Z  (I,  X*1) 

IP  (.NOT.  NOTLAS)  GO  TO  190 
P*P+ZZ*Z  (I,  Kt  2) 

Z  (I , K*2)  *Z(I,  K*2)  *F*8 
190  Z(I,K*1)*Z(I,K*1)*P*C 

ZJI.JC)  *Z  «,*)  -f 
200  CONTINUE 
210  COHTINUE 
GO  TO  40 

C - ONE  BOOT  POOND - 

220  H  (SN.EN)  *X*T 

HB  (EH)  *H  (EN,  EN) 

HI  (EN)  *0. 3D0 
EN*NA 
GO  TO  30 

C  — - —THO  BOOTS  FOUND - 

230  P»(I  -  I) /2.0DC 
C»P*P+H 

ZZ*OSQBT  (DABS  (C)  ) 

8  (EN,  EN)  *X»T 
1*8  (EN  .  EN) 

U  (HA,  N  A)  *T*T 

I?  (Q  .Li.  O.OCO)  GO  TO  270 
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- asiL  eaib- 

22=P*0SIGS(22,E) 

MB  (MX)  =  X  +  ZZ 
BE  (EN)  =  BB  (Hi) 

IF  (22  .  ME .  0 . 000)  MB  (EN)  *X -B/ZZ 
MI  (MA)  *0.000 
MI  (EM)  *C  .  GDO 
X*H(EN,NA) 

S*DA8S  (X)  »DA3S  (Z2) 

P-X/S 

Q*ZZ/S 

R*CSQHT (P*P*Q*Q) 

P*P/B 
C*C/R 


240 

C— 


250 
C—  - 


260 

C  — - 
270 


280 


C— - 
c— - 
290 


C - 

300 


310 

320 

330 


- SOB  MODIFICATION - 

DC  240  J*NA,M 
ZZ=H  (NA,  J) 

H  (NA,J)  =C*ZZ«-P*H(EN,J) 

H  (EN,ji  *Q*H(EN  ,J)  -F*ZZ 
CCNTINU  E 

- COLUMN  SCDiriC  ATION - 

DO  250  1*1, EM 
ZZ*H  (I ,  M  A) 

H  (I,NA)  =C*ZZ*E*H  (I , E N) 

U  (I.ENS  *C*H(I, IN)  -P*2Z 
CONTINUE 

- ACCUMULATE  TBANSFGFMAIIQMS-- 

DC  260  I*LOB,IGH 


22*2  (I  ,  N  A) 

2  (I,NAJ*C*ZZ>P*Z  (I,  EE) 
Zjl.EMi  =C*2(I  ,EN)  -P*Z2 
CONTINUE 


ZZ 

GC'TO” 280 

- COMPLEX  £AIH - 

BE  (NA)  *X*P 
MR  <EN)  *X  +  P 
81  (NA)  *2Z 
MI  (EN)  =-ZZ 
EM*  £NM  2 
SO  TO  30 

- ALL  FCCTS  FOUND.  EACKSUB STITUTE 

- VECTOa'  OF  UPPEB  T  E  I A  NGU LAS  FOBM- 

IF  (NOBH  .EQ.  O.OCO)  GO  TO  51C 
DO  450  N  N * 1 , N 
EN=N*1-NN 
P*MB  (EH) 

Q*MI (EN) 

MA*EN-  1 

IP  (Q)  370.30C.450 

- a  CAL  VICTOB - 

H*EH 

H  (EN.2N)  *1.000 

IF  (NA  .  EQ.  0)  GO  TO  450 

DO  360  11*1, MA 

I*EH-II 

H*H  (I, I) -P 

B*H  (I,  EN) 

IF  (M  .GT.  NA)  GO  TO  320 
do  310  j*n,;iA 
B!R4HiIjO»rH10,§M|)co, 


DO  ?IND- 


IF  (M 
t-M 


c~- 

340 


,G£.  O.OCO)  GO  TO  330 

22*  ' 

S*H 

GO  TO  360 
a*  i 

IF  (MI  (I )  .HE.  fl.ODO)  GO  TO  340 
T*H 

IF  (B  .EQ.  0.000)  T*fliCHEP*  HO  EE 
HjI.EM) --B/T 
GO  TO  36  C 

— - - SOLVE  BEAL  2Q0ATI0NS- 

X*H  (I ,  I*  1) 

I*  H  (I*  1,1) 

Q*  (MB  (T)  -  P)  *  (SB  IX)  -  ?)  *81  (I)*SI(I) 

T*  (X  «  S  -  ZZ  *  " 

H  (I, EM)  “T 


a)/G 
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350 
360 
C — 


c - 

370 
C  — 
c  — 


380 

390 


400 


410 


c — 

420 


430 


440 
C  — 
450 
C  — 


460 
470 
C  — 
C— 


I?  (DABS(X)  .  L  E.  EABS(ZZ))  GO  TO  350 
"  *  t,/x 

-  1  *  I,/2Z 

- END  aEAL  VECTOB - 

GC  TO  450 

- CO  3 PL  2X  VECTOB - 

a*  a  a 

- LAST  VECTOR  COMPONENT  CHOSEN  13 AGIN  A3 7  SC  THAT - 

- 21 G  ENV  ECTC3  -ATBIX  IS  TRIANGULA* - 

IF  (DABS  <H(EN  ,  NA)  )  .IE.  DA3S(H(NA,2N)))  GO  TO  380 
H  (NA.  N  A)  =  Q/U(  EH,  NA) 

B^HA.EtU  =-<a(EN,EN)  -  ?)/H(SN,NA) 

Z3  =DC1  PL X  (0.  3D 0,-H  (NA.EN)  )/DC RELX  (U  (  NA,  S A)  3) 

H  (NA,NA)  =CaEAL  (23) 
a  (NA , Z N)  =Di:iAG  (23) 
a  1  E‘( ,  N  A)  *C.0DG 
a  (EN,  SN)  *1.000 
ENN2*N  A- 1 

IF  (EN  .12  .SO.  0)  GO  TO  450 
DO  440  11*1, SNB2 
I*NA-II 
B*8(I,I) -P 

ba*ij.5  co 

SA*H  (I  ,2N) 

DO  400  J  * M, N  A 
BA*SA*H  (I.J)  *H  (0  ,  NA) 

SA*5A*H  (I.J)  *H  (J,  EK) 

CONTINUE 

IF  (41(1)  -GE.  0.000)  GO  TO  4  10 

ZZ=W 

B*  8  A 

Sa<A 

GO’TO  440 
1*1 

IF  («I(I)  .ME.  C.OCO)  GO  TO  420 
Z3*DC3ELXJ'3A,-SA)/0CaPLX  (W.Q) 
a  (I.MA)  *C3EAL  (23) 
ak.SN)  =CINAG  (23) 

SO  io  440 

- SOLVE  COMPLEX  EQUATIONS - 

X-H(I,I*1) 

i*a  (i*  i.i) 

VB*(»B(I)  -  ?)*JSB(I)  -  P)*«I(I)*WI(I)-Q*Q 
VI*  (NR  (I)_  -  ?)  *2  .  ODO  *0 

IF  (VB  .  £0.  O.OEJ  .AND.  VI  .  EC.  O.ODO)  VB=MA  CH  EP*NO  H3*  (DABS  ( S)  ♦  D 
1  AES  (Q)  ♦  tABS(X)  ♦  CABS(T)  ♦  0ABS(Z2)) 

Z3*0CS?LX  (X*H-ZZ*8A*Q*SA,  X*S -ZZ*S  A-Q  *BA) /DC3PLX  (VR.  VI) 

B  (I,  NA)  *CHEAL  (23) 

HjI,EN|*CI«AG  ?Z3) 

IF  (DA  oS  ( X)  .IE.  CABS(ZZ)  ♦  DAES  (Q)  )  GO  TO  4  30 
a  (1+1,  NA)  *(-BA  -  K  •  Hfl.NA)  ♦  Q  •  H(I,2N)|/X 
Sill'S, ‘  8  *  Hil ,  SH)  -  3  •  H  (I ,  N A)  )  /X 
GC  TO  440 

Z3*0CSPLX  <-B-Y»8  (I,  N  A)  ,-S-Y*H  (I.SN)  )  /CCSPLX (ZZ ,Q) 

8(1*1.  BA)  *DBEAI  (Zj) 

H  (1*1.  EN)*0ISAG(Z3) 

CONTINUE 

- ES0  COMPLEX  VECTOR - 

CONTINUE 

- - - END  BACK  SUBSTITUTION.  VECTORS  OP  ISOLATED  BOOTS - 

DO  470  1*1, N 

IF  (I  .GE.  LON  .AND.  I  .L2.  IGB)  GO  10  470 
00  460  J  *1 , N 
Z  (I.J)  *H  (I.J) 

CONTINUE 

- - MULTIPLY  EX  TB  ANS  FCHRATIO  N  .1  ATBIX  TO  GIVE - 

- VECTCBS  OF  OSIGINAl  FULL  BAT  BIX. - 

DO  490  3J*L0«,» 

4*N*L0N- JJ 
B*SINO  (J  ,  IGH) 

DO  490  I*LON,IGa 
ZZ*0.  7  DO 
DO  480  K*io«,a 
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1 

/ 


480  ZZ-IZ*Z  (T.K)  *H  (»,«) 

3  (Z,J)  =ZZ 
490  CONTINUE 

_ 22-22,  „2-_S2T  ESBOB  — >NC  COBVESGENCE  TO  AN- 

_ iiGjSvilLaE  ipteh  30  itesatio ns — 

0C  IE8E=EN 
10  BETUHN 
END 
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SUBROUTINE  3  A  L  E  AK  (  N  K.  S  ,  LOW  ,  IGH  ,3CA  L  E  ,  3  ,  2) 

INTEGER  I  ,J,  A  ,2,  N  ,11  ,NM  ,IGH  ,  LC4 

REAL**  SCALa  (S)  ,L  ( M  M  ,  M)  ,S 

IF  (a  .SO.  0)  GO  10  oQ 

IF  jlGH  .IQ.  ICR)  GO  TO  30 

DO  20  I  3  LC  4  ,  I G  H 

S  =  SCALE(1) 

- LEFT  RANG  EIGESVECTC3S  ARE  EACK  TRAGS 

- IF  Tfe  FOREGOING  STATEMENT  IS  REPLACE 

- S  =  1  .  ;JC/  SCALE  (I)  . - 

dc  io  j«i,a 

c(5sfi!t5l<I,J)  *£ 

DO  50  11*1, S 
I»II 

IF  (I  -GE.  LOS 
IF  il  .IT.  LOU) 

K*SCALE  (I) 

IF  <K  .  *'• 

DO  40  J 
S»Z  (I,  J) 

Z  (I,J)  3Z  (K,J) 

Z |K, J)  =  5 
CONTIS OE 
COST  IS  U  E 
RETURN 
EMC 


FORMED 
0  31  — 


.£ C.  i) 
j=T,a 


.AND.  I  .  LE. 
I*  LC  4-1 1 

GO  TO  50 


IGS)  GO  TO  50 
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c— 

10 

20 


30* 


c— 

40 


SO 
c  — 
60 


c— 

70 


90 

C— 


SU  EBOOT I  5  £  9C  S  (X  K  ,  S  .LOW  ,  IG  H  ,  E  -  i  B  ,  ill  ,  I E  B  8) 

INTEGER  I <,1,3,5,  cN,  LL  ,  .1 B  ,  N  & ,  3  3  ,  I  ,  IIS  ,  LOW  ,.1F2 , 2NB  2 , 1 I  BR 
8EAL*3  a  (tll.Hf  .la '  (if  ,wf  <N> 

8EAL*9  P,C.B,S,T,H  .X.Y.ZZ.NORf.BACHEP 
3 EAL*9  D§c5.T*  ciES  .CSIGN 
INTEGEB  KINO 
IOGICA L  NCTLAS 

OAT  A  BACEEP/zSm  1 0COO  COOO  000  0  0  / 

IERR*0 

MCBM*O.OEO 

K*1 

- STORE  FOOTS  ISOLATED  3Y  BAIANC  ANC  COKPUTE  NAT’IX  MC33 - 

DO  20  1*1,3 
DC  10  J=K,.'J 

N0Ra=N0PB*PA3S  (H  (1,0)) 

K*I 

IF  (I  .GE.  LC  S  -AND.  I  .  LE.  IGH)  GO  TO  20 
MB  II)  *H  (1,1) 

MI  (I)  =0.  CCO 
CONTINUE 
E3*iGa 
T*0. 0D0 

- SEARCH  FOR  A  EXT  EIGENVALUES - 

IF  (EN  -LT.  LCB)  GO  TO  250 
ITS*0 
N  A*  EN-  1 
ENB2*NA-1 

- LOCK  ?ca  SINGLE  SHALL  SUB-DIAGONAL  3LS3E3T - 

DO  5C  LL=LOW,SN 
L*EN+LOW-LL 

IF  (L  .EC.  LOS)  1C  TC  60 
S*CA3S  (H(L-I.L-I)  )  »D  ABS  (H  (L  ,  L) ) 

IF  (S  -EC-  O.OEC)  S=N08H 

IF  (DABS  (H(L.  t- t)  )  .  LE.  3ACHEP  *  S)  GO  TO  60 
CONTIN  DE 

- - - F033  SHIFT - 

X*«(EN,EN) 

IF  (L  .EC.  EH)  GO  TO  200 
Y  =  H  NA  ,  N  A) 

9*HiEN,NA)*H(Ni,£X) 

IF  iL  .EC-  HA)  GG  TO  210 
IF  -  ITS  .EQ.  30)  GO  TO  240  , 

IF  UTS  . NE .  1C  .AND.  ITS  .HE.  20  GC  TO  90 

- f0aa  EXCEPTIONAL  SHIPT- 

T*l*  X 

DC  70  I*  LCM , EN 
H  (I. I)  *H  (1,1)  -X 

S*  CABS  (H  (EN,  N  A)  )  ♦  £  AES  (H  (  NA,  EN  B2)  ) 

X*Q.75D0»S 
Y*X 

M*-0.4375DO*S*S 
ITS*IT  S ♦  1 

- LOOK  ?OR  TMO  CCNSECDTIVS  SHALL  SUB-DIAGONAL  ELEMENTS. - 

DO  90  BB*L,3NH2 
N*eN32+L-lia 
ZZ*H(H,fl) 

8*X-ZZ 
S-Y-ZZ 


P*  (8  •  S  -  M) /H  (C*1 ,»)♦«  (i,a»1) 
Q*H  (B*  1,  H  +  1)  -  ZZ-8-S 
B*H(B+2.B*1) 


90 

100 


110 


n  —  a  i  a-  * ,  1 ) 

S*  CABS  (P)  *0  ABS  (C)  ♦  CAES(R) 

P*P/S 

K& 

IF  (!)  .EC-  L)  GO  TO  100 

IF  (DABS  (H(a,B-1)  )  *  (D&BSJQ)  ♦  DABS  (8)  )  .LE.  3ACHEP  *  DABS(P) 
1  *  JD1BS  (H(B-  1,3-1)  )  ♦  DAES(ZZ)  »  DA  BS  (H  (3*  1  ,»♦  1 )  )  )  )  GO  TO  100 
CONTIN  UE 
HE2*3*2 

DO  110  I-BP2.EN 
B  (1,1-2)  *0.060 
IF  (I  .EC-  3P2)  GC  TC  110 
H(I,I-3)  *0.000 
CONTINUE 
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->»  I 


C - DO tI3 I Z  OR  STEE  INVOLVING  SOW S  L  TO  EN  AND  COLUMNS  M 

dc  i)o  :<*s,:u 

NO ILAS  =  K  .  N£  .  N  A 

IF  (K  .  SC.  .1)  GO  10  123 

P»B(1C#K-1) 

Q*a<K»  1,  K-1) 

r=c.odo 

IF  (NOTLAS)  3=e<R  +  2.K-1) 

X*DA33  (?)  +  0A3S  JC)  *D  ASS  (3) 

IF  ((  .EC.  0.0  C0{  GO  TO  190 
?  =  ?/X 
C=C/X 
R  =  3/X 

120  S-CSI3M  (CSCRT (F»P«C*C+S*R)  , P) 

IF  (K  .EC.  3)  GO  IC  130 
a  (K.K-n  =-s»x 
go  ro  i«c 
no  IF  (L  .  N  F . 

140  P*P+S 
X  =  E/S 

ZZ=ft/S 
0*0/? 

5=3/? 


150 
160 
C - 


170 

180 

190 


C - 

200 


C - 

210 


C— - 
223 


230 

C- 

fttO 

250 


EM - 


3)  H(K,K-1)*-H(K,E-1) 


DO 

P 


160  J*K,EN 
P*H  (K,  J)  *0*H  JK ♦  1  ,J) 

IF  (.'ICT.  .10 1  LAS)  GO  TO  150 

P=P*3«H  (S+2 ,J1 

H  (K*2,  Jl  =H(iC  +  2,J1  -?*ZZ 

B  (S+1.J)  »H  (K*  1  ,J)  -?*V 

a  <K,J)  =H  (K.J)  -E*X 

CCNTI'IOS 

J=MN0 (SN,K»3) 

— - COLUMN 

DO  180  I*L,J 
P»X*H(I,K)  »T*H  (I,K*1) 

I?  ( .  N  CT .  NOT  IAS)  GO  TO  170 
E»E*ZZ*U  (I,K*2) 

H(I,S*2)  =H(I,K*2)-P*3 
alz.K*  If  =8 -P*Q 

CONTINUE 
GO  TO  40 


-ROW  HODIFICAT ION- 


MOD  I?  I  C  All  ON  - 


MB  (EM)  =  X  ♦  I 
BI(EN)  =0.  ODO 
EN=NA 
GC  TO  30 


-ONE  HOOT  FOUND- 


P«  (7  -  X)/2.3C0 
0  =  P*?»  « 

ZZ=DSQBT  (CABS  <« ) 

X  =  X*T 

IF  (Q  .LT.  0.010) 

ZZ=P*OSIGN(ZZ,E) 

MR  (NA)  =X*ZZ 
BB  fEN)  =«B  (HA) 

IF  (ZZ  .NE.  0.000) 
MI  (N A)  =0.000 
BI  (EM)  =0  .  ODO 
GO  TO  230 

MB(MA)  =X»E 
MB  (EN)  =X*E 
BI  (NA)  =ZZ 
MI  (EN)  «-ZZ 
EN-ENN2 
GO  TO  30 


-TBC  ROCTS  FOUND- 


GO  TO  220 
- SEAL 


EAIB- 


BB  (EN)  =X-B/ZZ 


-COSPLEX  PAIB-- 


IEHB=  J3 

RETURN 

END 


-SET  EEEOR  —  NO  CONVERGENCE  TO  AN- 
-SIGENVALUE  A  FT  EH  30  ITERATIONS - 
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SUBROUTINE  PSDCAl  (N2  ,NS  ,  FA  ,  X  ,  JC,  GS  ,  GV  , C, NO- NT, 30 , 3, 

1  ESSE,  MG,  GAM  ,  ACL,  (,  WR,  '4 1 .  D  1  .  £2,JC?,  RES  ,  J  ,  3 , 3tt  ,CC  ,  I  Y  U  , 

2  IPSD.INOEM) 

KSSXSXB  2  *S3as»3Sl=S  SSX29t*SS3Slia  32322ZII3  33*1133333;; 33=333  3 

*  PSD CA  X  COMFC1ES  TEE  PSC  CP  OUTPUTS  CF  CONTROLS  OP 

*  A  CONTHOLLEG  SYSTEM 


C 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


c- 

c- 


40 

50 


c— 

60 


70 

ao 


Ira*  i 
*  2 
=  i 

ipsc=i 

=2 

i:icem» 


OUTPUT  PSD 
CCSTROL  PSD 
EOT  u  output  as: 


S  N  I  ..G  L  PSD 


PSD 

ESC  AND  TF  .RESIDUES 


1.2,...  NG  SCUM  ALT  ZED  3  X  ITH  PROCESS  NOISE 
SG»1,...  NG  ♦  )C  NORM  ALI 2  EC  dY  ITH  1 EAS  NOISE 


10 

20 

30 

C— - 


DOUBLE  PRECISION  f  A  ,  X  ,G  W  .07  .  C  ,HT ,  H  ,  F  HGE  ,  G  AM,  ACL, /,  S  a  ,  3  l,  0  1  ,  C2  ,  .R  ES, 
1 EE.CC, Q, R.PSD.W.CNORS.DN 1  .EM  A  X ,  FLOG  ,  ESOD,  D  W,  S?  .OH  ,d  £  ,AI,  HO  ,  DW  1 
COMPLEX  »16ZD,ZN,2Z 

DIMENSION  ?.\  (N2.N2)  ,  X(N2.N2)  ,  GW  ( N  2,  N  G)  ,C  (NC.NS)  ,  HI  (  NO  ,  S2>  ,H  (NC.NS) 
1,7SG2(NS,N0|  ,  G  AM  {  AS  ,  JiG)  ,  ACL  (  NS  ,  NS|  ,  ?  (  NS  ,  (iS !  .  *3 ( N2)  , W I  (  N2)  ,  D  1  ( )li)  ,  D 
22  ( N2)  3  RES  (N2)  ,  C  ( N  C- .  N  G)  ,  3  (NO, NC),  PSD  (30)  ,4  ( Jj  )  ,  33  ( N  2 )  ,  CC  (M  2)  .OVINE, 
3 NCI  .iff)  (NC.N21  ,  CK1  (4) 

INTEGER  JC?(N2) 

DATA  381/1.00.5. DC, 5. DO,  10.00/ 

IF  (IYG  .  EQ.  C)  I  YU-  1 
IF  (TNOHH  .EQ.  0)  INOGfl*  1 
I?T*0 

IF  (IPSD  . GT.  1)  IPT=1 
IX=LNQ  3K-NG 

IF  (IX  .GT.  0)  WRITE  (6,3  30)  IX 
I?  IX  .LE.  0)  WRITE  (6,340)  I SCRM 
NSC=N2*N2 

- COMPU1E  EIGENSISIEB  OF  CO  STROLLS  C  SYSTEM;  FORM  FA - 

CC  10  I*J,NS 
DO  10  Jszl  NS 
FA  (I.J)  =  ACL(I,  J) 

DO  20  Kal.NO 
ST»ST+FBGf  (I,K)  *H(X,  J) 

FA  (I,NS*J)=-ST 
FA(NS*I,NS*J)  *f  (I.J)  -ST 

CALL  R AP ENT  (N2,N.,N2,9,FA,4,  •  (9(11,  1T013.5)  )  ’) 

- DE3UG  ABOVE - 

CALL  dALANC  (  N  2 , 3  2  ,  E  A  ,LOW  ,1  HIGH,  S  1) 

CALL  ORTHES  <  N2  ,  N2  , ICW,  1 3 TGH  ,  F  A,  C2) 

CALL  OHTEAN  ]  N  2,  N  2 ,  LOW,  I H IG  H ,  l  A  ,  D2,  X  ) 

CALL  H 03 2  (N2,N2,ION,IHIGH,?A,«B,WI, X.IERR) 

IF  (I2RH  .NE.  O)  GO  fo  320 

CALL  3ALBAK  ( N| ,  N2  , ICS. 1  HIG B  ,  C 1 ,  N2, X  ) 

CALL  R AP fi NT  (N2,N2,N2,9,  x,4,  '  («( IX,  1  PD  1  3.6) )  ') 

- DEEUG  ARCVE.'DETSaHINE  SCDAL  MATRICES - 

IT  (ITU  .EQ.  1)  GC  TO  60 

- HSU3U - - 

DO  50  I a  1 , NC 
DO  50  J*  1 , N2 
ST*O.DO 
DC  40  Kal.NS 
ST-ST-C  (I,K)  «T  (f  ,J) 

HO  (I.J )«s{ 

GO  TO  90 

- - - a  SUSY - 

00  80  1*1  , NO 
DC  80  J*  1,M2 
SI*O.DO 
CC  70  K*  1  ,NS 

ST*ST+H  (I.K)  *X  (F,J)  -  H  (I ,  K)  *X  (SS*K,J) 

HI  (I.J)  *ST 

CALL  3APSNT  ( NC  ,  SC  ,»2,9  ,  HT,  4  ,  •  (9  ( IX ,  1  PD  1 3 . 6)  )  • ) 
- DEDUG  ABOVE - 
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90 


C- 

c- 


100 

110 


120 
C- 


D 


130 

140 
C - 

150 


160 
C - 


170 
C - 


CALL  BINV  (NSC.X.S2,ST,D1,D2) 

CALL  3APRST  <N2,N2,S2,9,X.4,'  (9  ( 1  X,  1  E01  3. 6) )  •) 

— — — —  — — —  ———————  —  — — — — —  — — —  0  2  SO  G  A  BO  V  E— —  —————— - ———————— - 

- GSUBW - 

00  110  1*1, N2 

do  no  j*i,sg 

ST =0.0  CO 

DO  100  K*1,NS 

ST=S7-X  (I,SS*K)*G*a(K,J) 

GKjt.JI  =  ST 

CALL  3  A?  ENT  <N2,:i2,NG,9  ,GH.4  ,  1  |9(1X,  1PD13.6)  )  •) 

- OEBtJG  ABOVE;  USE  SELECTEE  M03HA  LIZATION - 

IF  (IN  OR  B  .L£.  MG)  D  NORM»1.  DO/C  (IMOa  B,I  NOfifi) 

if  (isoaa  .gt.  SGI  ct;oaa»i.oo/fi{i3cas-!iG,i30Ra-*G) 

- DETER MIME  BANDWIDTH  CF  CO  NTRCLLED  SYSTEM 

E«AX=0 . DO 
00  120  1*1, H2 

EBCD*OAES  <33  (I)  *«2  ♦  «I(I)«*2) 

I?  (E3O0  .GT.  EBAI)  EBAX*EBCO 

CONTINUE 

EBOD*OSQET  (EM  AX) 

saoo*2  *sacD 

- BOO ‘.ID  OP  TO  HEAR  EST  2,4,5,6,10 - 

SLOG*D LOG  10 ( E  HOD ) 

IF  (ELOG  .LT.  0.DC)  IPO  W*-ID  1ST  ( DABS  (SLOG) 

IF  jELOG  .GS  .  C.DC  IPO  ■  *  ID  I  ST  (E  LOG) 

EflAI*  SMO  E*1 0  **  IPO  ii) 

I?  (EM  AX  .GT.  2. EC)  i“OD*2.DO 
IF  (S»AX  .GT.  4 .  DC)  ESOD*U.  DO 
IE  (EMAX  .GT.  5. DC  EnOD=5.D0 
IF  (EMAX  .GT.  g.od  E«OD=R.D0 
IF  (EMAX  .GE.  10.10)  EMOD  =  10.C0 
2SAX=EMOC*10**IED* 

DH*EMAX/20 .00 

- &DC  13  PO I  MTS  3  DECADES  UP- 

IF  ( EMOD  .LT.  5.J)  GC  TO  130 
EBAX*1 .001 
IK*3 

GC  TO  1 4  C 
EH  AX*5 .DO 
IK*2 

CONTINUE 

■ariio“20 . 5TC8S  30  ?BECUSSCI£S . 

WWUY.V 

IP*2Q*3*  (1-1) 

DO  160  J*  1, 3 
IX*aOD  (IK+J-1  ,3)  +1 
JJ=0 

IF  (IK  .EC.  2  .  ANE 
W  <IP+J|  *CH1 
CONTIS  UE 
IX»aOO(IK,3)  *1 
H(3Q)  *0N1  (IX)  *10**  <IF0»*3 


_  _  J  . GE.  2)  JJ=1 

1  (IX)  *10**  (IPQW+I-  1*JJ*IK-  2) 


IF  (I  Y  U  .20.  1)  Sl=NC 
IF  jlY  0  .IQ.  2)  SL=NC 
DO  310  L*1,SL 


-LARGE  LOOP  THRU  OUTPUTS- 


180 


00  170  1*1,30 
PSD  (I)  *0  .DO 

- LOOP  THRU  PROCESS  NOISE - 

DO  220  1*1, SG 
D81*ONOBB*Q(I,  I) 

IF  (IYU  .EQ.  1  .AMD.  IPT  .20.  1)  3BIT2  (6,350)  I,L 
I?  (IYU  .  EQ.  2  .AMD.  IPT  .EQ.  1$  VRITE  6,360)  I,L 
IF  (ITU.2C.lt  CALL  3  ESID  (I ,  L  ,N2 ,  JCF  , NG  ,GW , .1 L,  HY ,  38  , 31 
IRIS, B3.CC. IPT) 

IF  (IYU.EC.2)  CALL  RESID  (I,L,N2,JCF,NG,3W,NL,UU,33,3I 

Iris,  bb  ,  c  c  ,i  ?t  ) 

DC  210  K*  1, 20 
Z2*0CMPLX (0.00,0.00) 

§rm,n.i,N2 

II  (HI  (II))  200  ,  180,  190 

ZD*DCBPLX  (-HR  (ID  ,CB-HI  (II)  ) 


190 


200 
210 
220 
c - 


230 

240 


ZZ=R2S  (IU/ZD+ZZ 
SC  TO  200 
aE=»a (ii) 

*I=WI III) 

Z0*DC3?LZ  (RE**2  ♦  AI**2  -  0 B* *2 , -2.  DO *R E*OR) 
ZN=DCRPLX  (azs  (11*1)  *AI-RES  (II)  *8E,HES  (II)  *0.'!) 
zz=zz*-z;i/zd 

CONTINUE 

PStfjK^jjPSD^)  *DS1* <ZZ*DCONJG  (ZZ) ) 

— i — i - sou  a  7 - 

DO  240  1=1, 3  2 
DO  240  J=1,N0 
ST=0. 00 
DC  230  K=1,NS 

ST=S7«-X  (I.X)  *  F  EG  E  |K,J)  *X  (I,NS+K)  *?°GE  (K,J) 
G7(I,J)=S1 

CALL  R  A  P  6  NT  < N  2 ,  N 2,  NO,  9 ,  G V,  4  ,  *  ( 9  ( 1 X,  1? D  1 3 . 6)  )  • ) 

- DEBUG  A3C7E,  LOO?  THECJ  SEAS  SO  15  2- 

DO  300  1=1, NO 


DN1 

IF 

=DNCRH*R  (I 
(IIU  .EQ. 

,1)  „ 

1  .AND. 

IPT  .EQ.  1) 

•  FITE 

IF 

(iru  .Eg. 

2  .AND. 

IPT  .EQ.  1) 

WHITE 

IF 

(ITU.  EQ.  1) 

CALL  R 

ESID  (I,L,N5 

\  §  z  f  NG 

.  3B , CC, IPT) 

IF  (irO.Eg.2i  CALL  RESID  (I  ,  L  ,S2  ,  OC?  ,  NO ,  G7 ,  XL ,  HU .  NR ,  W I ,  ?  SS  , 

1  BB,CC,IPT) 

DO  290  K»1,30 
ZZ=DCRPLX  (5.CC,0.tO) 

OF.  =  «(K) 

DC  270  11=1, N2 
IF  (WI(II))  27C.25C.260 
ZC=DC.1PLX  (-W9  (II)  ,OS-WI  (II)  ) 

ZZ=ZZ*aES  (II)  / 2D 
GC  TO  270 
BE  =  WR (II) 

41=41(11) 

ZD=OCapLX (RE**2  ♦  AI»*2  -C.N **2,-2.  DO  *RE  *ON) 

ZN=  DC3  PLZ  (RES  ( II ♦  1)  *  AI- R  ES  (II )  *RE ,E 3  S  (II )  *03) 

ZZ=ZZ*ZN/ZD 
CONTINUE 

IF  (HO  .Eg.  2  .CH.  I  .NE.  L)  GO  TO  230 
ESC(K)  =  PSC(K)  *131 

PSD  (K)  =PSD(K)  *DN1  *  (ZZ*DC0  8JG  (ZZ)  ) 

CONTINUE 
CONTINUE 
IP  - 

HEItE  (6,410)  (H(I)  ,  PSfl(t)  ,I=i;30) 

CONTINUE 
BETUBN 
CONTINUE 

CALL  EEEZIT  (N2,E»,IE5R) 

RETURN 

FORNAT  (/  ,4 1  H  SUOSECUENT  PSD  IS  NORN  ALIZED  31  SEAS  NO., 13) 

POfiBAT  (/,50a  SUBSEQUENT  PSD  IS  NORN  ALIZED  3T  PROCESS  NOISE  NO. ,13 

tcEBAT  (/38H  TRANSFER  FUNCTION  PRCB  EEOCESS  NOISE  ,I2,3R  IO,13H  BE 
1  AS 0 RES EN T  .12) 

FORNAT  ( /38H  IHANSF5  B  FUNCTION  PROS  PROCESS  NOISE  ,I2,3H  TO,9H  CCN 
1THCL  ,12) 

FORNAT  ( /36H  TRANSFER  FUNCTION  F  BOR  3EASU  RESENT  ,12,163  TO  3EASU32 
1  BENT  ,12) 

^FORNAT  (/36H  TRANSFER  FUNCTION  PROS  SEA SURER ENT  ,I2,12H  TO  CONTROL 

F<5aRAT  (/1#H  PSD  CF  OUTPUT, 13 ,32H  FCSCED  El  ALL  NOIS2-(2AD  FREQ,, 
1  ISHNORSALIZED  ESC)/) 

FORBAT  (/  15H  PSD  CF  CCNTSCL,I3,32H  FORCED  BT  ALL  NOISE- (RAD  FR2C* 
1  ,  15HNO  RB  ALIZED  PSD)/) 

FORBAT  (4  (IX,  1B(,  ii  1.4,  1H,,  El  1.4,  1H)  ) ) 

END 


250 

26C 

270 


280 

290 

300 


310 

320 

C - 

330 
34  0 

350 

360 

370 

380 

390 

400 

410 


STIR  UE 

(ITU  .EQ.  1)  S  RIT E  (6,390)  L 
IlYU  .EO.  2)  WRITE  (6,400  L 
ITE  (6,410)  (11(1)  ,PS0(I)  ,1=1,3 
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non 


Cx»>MS*s*s«*a*s3i3tt«xta*ssas«s3a3ss«xsss  sssssassixax  sassss  ssss  a  a 

S  D  E80U  T  I H  £  EREXIT  (N  ,  A,  IEB3) 

EREXIT  RETORSS  THE  NUMBER  OF  THE  SIG  ENV ELSE  <f  K  EH  E  HQR2 
F  AILS ,  THEM  STOPS  THE  PROGRAM . 


taassaissa asa 


XHTEGSE  IIP.H 
DOOBLE  P8ECISICM  A 
DIMENSION  A(S,;i) 

Via  I  IE  (5-10)  I  EBB 

CALL  R  AP  BN?  (  N  ,N  ,  S,  9  ,  A,  4  ,  1  (  9  (  IX,  1F3 1  3. 6 ) )  •) 

RETURN 

FCfiHAT  (35H  FAILURE  IS  HQR2  OS  EIGENVALUE  SO.  ,13) 
ESD 


c 

c®» 


I*  ®**3*S***5*SSSS3SSSSSa  -  33SS3S353333  333  MS33XXZ331S3n3»3  XXXXXXXX 

SUBROUTINE  REACE  (N5,ISAF,3A) 

INTERACTIVELY  ENTERS  THE  f,P"  MATRIX  ELEMENT  31  ELEMENT.  * 


I3XXXXX3X333X3333 


10 

20 

c— 

30 

40 

50 


60 

70 

ao 


REAL*8  BAINS, AS)  ,D0M,ANSE 
INTEGER  I,J,K,t,IANS,ISAF 
DATA  IX/'T'/.IZ/'NV 
IP  jlSAF.EO-  1)  GO  TO  40 
BRITS  (5,130) 

DO  20  I®1,NS 
DC  10  US 

WRITE  (5,120)  I,J 
CALL  RDREAL  ( ANSI!) 

BA  (I.J)  *ANSa 

CONTINUE 

CONTINUE 


53333333  3333  33333 


3  333  333333333333 


GC  TO  110 
GC  TC  SO 


90 

100 

110 


C - 

120 

130 

140 

150 

160 

170 

180 


CALL  ? 5TCMS  ('CIRSCSh  •) 

CONTINUE 
BRITS  (5,140) 

CALL  MATEST  (EA,NS,NS) 

WRITE  (5,150) 

CALL  RuCEAR  (IANS) 

IP  ((IANS. HE. IT)  .AND.  (IANS. ME.  12))  GC  TC  60 
GO  TO  70 
WRITS  (5,160) 

GC  TO  50 
CONTINUE 
IF  (IANS.  EQ.  12) 

IF  llAN3.2Q.IT 
WHITE  (5,170) 

CALL  RDINT  (IANS) 

K«IANS 

WRITS  (5,180) 

CALL  RDINT  (IANS) 

L*IANS 

WRITE  (5,120)  K ,  L 
CALL  RDHEAL  (ANSS) 

DUM=ANSR 
DO  100  1*1, NS 
DO  90  J* 1,3S 

IP  J  Cl  -SQ.K)  .  AND.  (J.  EQ.  L)  )  BA  (I,J)*OOM 
CONTINUE 
CONTINUE ' 

GO  TO  30 
CONTINUE 

CALL  P9TCMS  ('CL3SCRN  •) 

RETURN 

FORMAT 
FORMAT 
1ENSION 
FORMAT 
FORMAT 
1  ENT? ,  // 

FORMAT 
FORMAT 
FORMAT 

1  E&D 


(5X.14KTHE  ELEMENT  F  ( .  12 , 1  H . ,  12, 2H)  *1 

1/.5X,  36EENTEH  THE  SYSTEM  MATRIX  l,F1,-MATRIX  ,//,  10  X,  4  1HDIM 
=  *  STATES  NS  X  *  STATES  NS  ) 

(//,  1  5 X .33HTH2  SYSTEM  MATRIX  "r "-MATRIX  ...,//> 
l//5X,54aDC  ICO  WISH  TC  CHANGE  T BE  VALUE  OF  ANT 
,  10X,19BTYEE  "TES"  OR  "NO".) 

•1X,51HSARNING:  IMPROPER  DATA  ENTRY!  ENTER  "TES"  OR  "NO".) 
5X.50HENTER  THE  HCW  NUMBER  OF  THE  ELEMENT  TO  3E  CHANGED.) 
5X.53HENIER  THE  COLUMN  NUMBER  OF  THE  ELEMENT  TO  BS  CHANGED 


MATRIX  SLEM 
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Csva  =■*-*■**  *»  a  a  *  xxx  =  a  s  tssts  saaas  ssssssssxss  ss«*3cs«sx  a  sssi  sss  xssxs  ssssssss 

SOEBOUTINE  BEACH  |NC,NS.ISAH,HC) 

C  I NTES  ACT  IV  ELI  ENTERS  THE  «HM  MATRIX  HEASUREBENT  SCALING  3AT32X  .= 

C  *  *  *  S**S=3X  SlXIHI»3*a3SaXlS39U3  3U3n>8>33SXX3SBSSXSXSKC3  S  S3 


HEAL*  8  EC  (NO  ,  NS)  ,  DOS,  AMS  3 
INTEGER  lANS.I.J.X.L.ISAH 
DATA  IY/' T' /, 12/ *  N ' / 


C  TEIS  IS  AS  EXAMPLE  CF  CSE  POSSIBLE  METHOD  C?  AREA'/  GEM EfiATION 
C  HITHIN  THE  PROGRAM  ITSELF.  EOS  VERY  LARGE  DATA  ASSAYS,  THIS  METHOD 
C  BAY  ei  EREFLBAoLE  IC  SOKE  USEHS  OVER  INTERACTIVE  ENTRY  OR  EACH 
C  INDIVIDUAL  ELSE. E  ST. 


c - 

r> 

DO  2  1*1,11 

c 

DO  1  J» 1 , 9  2 

c 

HC  (I.J) 

as 

0.00*00 

c 

BC  ( 1  ,  l[ 

X 

0.  1 15  200  +  CC 

c 

HO  (2,75; 

X 

0.57  3  0D*O  2 

c 

HC(3, 74 

X 

0.10000*0  1 

c 

HC  (4 , 63 

X 

0.57300*02 

c 

BC (5,62 

X 

0.  1000D  +  0  1 

c 

HC  (6 ,76 

X 

0.57  3  OD  +  02 

c 

HC  (7  ,  *44 

X 

C. 57300*02 

c 

HC  (3 , 45 

X 

0.5730D*02 

c 

HC  9, 46 

X 

0.57300*02 

c 

HO  10.4 

M 

3 

0.  57  3  OD  *0  2 

c 

EC  (1  1.48) 

X 

0.573  00*0  2 

Cl 

CONTINUE 

C2 

CONTINUE 

C 

GO  TO  90 

C3 

C - 

CONTINUE 

10 

20 

C— 

30 

40 


50 

60 

70 


80 

90 

100 


C  — - 
110 
120 


IF  (IS  AH-  EQ-  1)  GO  TO  40 
MBITS  (5-120) 

DC  20  1=1,  MO 
DO  10  J*1.NS 
H  BITS  (5,110)  I.J 
CALL  aDREAL  ( A  NS3) 

HO  (I.J)  =  AMSB 
CONTINUE 
CCSTINU E 


CALL  PRTCMS  (’CLRSCEN  ') 

CONTINUE 
HEITE  (5,130) 

CALL  HATPBT  (HC.NC.NS) 

HBITE  (5,140) 

CALL  RDCHAB  (IANS) 

IF  ( (IANS. NS.  IY)  .AND.  (IANS.  ME.  12) )  GO  TO  60 
GO  TO  70 
MBITS  (5,150) 

GO  TO  50 
CONTINUE 

IF  JIANS.EQ.IZ)  GC  TC  100 
WHITE  (5  ,  IbO) 

CALL  B  01  NT  (IANS) 

K»IANS 

HBITE  (5,170) 

CALL  ROIHT  (IANS) 

L«IANS 

HBITE  (5,110)  X ,  L 
CALL  P.DBEAL  ( A  NS  3 ) 

DUM=AHSR 
DO  90  1*1, NO 
DC  SO  J*1,SS 

IF  J(I  .EC  -X)  .AND.  (J.5Q.  L)  )  HO  lI,J)*DUa 

CQNTINOE 

CONTINUE 

GC  TO  30 

CONTINOE 

CALL  FRTCBS  ( '  CL3SCBS  ') 

BEIOBN 


FOB3AT  (5X.14HTHE  ELEHENT  H  ( ,  12 , 1H,  ,  12,  2H)  *) 

FOBBAT  (/.pX.SOEENTEH  THE  Nsi SORSBES  T  SCALING  MATRIX  "H"-SATBIX 
1,//,10X,47HDI8ENSICN  *  *  CBS  2  F  V  AT  ION  S  NO  X  *  STATES  NS  ) 
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ujom  -*  no 


E  3E3S3ESSX3  S3  33333  3  *3  333  3  333  3  333  3  33X3333  3  333  3  3  3  33  33  3  3  3  S3  333  33  53  3  3  3333  33 


S02ROUTINE  El  E  A  CD  INC, SC, D) 

ENT  ESS  TEE  "C"  MATRIX  .1  £  AS  0  RESENT  ?  EED-FOEWA8D  DIST. 


0 

0 

0 

40 

50 

60 


8EAL*8  C(!IO,SC)  ,CUM,ANSB 
IN1EGER  IANS  ,  I  ,0  ,  R  ,  L 
DATA  lY/'Y'/,  IZ/’n1/ 

WRITE  (5,110) 

DO  20  1=1, SO 
DC  10  0=1. NC 
S8ITE  (5,100)  I.J 
CALL  BDHEAL  ( A  NS  3 ) 

D (I.J)  =ASSR 
CONTINUE 
CQNTIN  UE 


SATES  IX 

:  222223  = 


CALL  FRTCSS  ('CL3SCSS  ') 

MBITS  (5,120) 

CALL  MATFBT  (E,NC,NC) 

WHITE  (5,130) 

CALL  HDCHAR  (IANS) 

IP  ((IANS.NE.il)  .  AND  .  (IANS.  NE . IZ) )  GC  TC  50 
GC  TO  60 
WRITS  (5,140) 

GO  TO  40 
CONTIM  OE 
IP  (IANS.  10.  12) 

WHITS  (5,150) 

CALL  3  DINT  (IANS) 

K=IANS 

W  BITE  (5,160) 

CALL  ROINT  (IA 
L=I ANS 


GC  TC  90 


(IANS) 


70 

80 

90 


C - 

100 

110 


120 

130 

140 

150 

16Q 


WRITE  (5,100)  If.L 
CALL  3  D  R  t  AL  (  A  NSR) 

D0a=ANSR 
DC  80  1=1, NO 
DO  70  J«1,NC 

IF  ((I.  EC-K)  .  AND.  (J.EQ.L)  )  D  (1,0)  =D0N 

CONTINUE 

CONTINUE 

GO  TO  30 

CONTINUE 

CALL  PRTCMS  ('CLHSCEN  ') 

BETOHN 


FCBMAT  (5X.14KTEE  ELEMENT  0  (  ,  12 . 1 H , ,  12 , 2H)  =) 

PORMAT  (/,5x,54H£NTEB  THE  MEASUREMENT  F EEDTHHOUGH  MATRIX 
1 W  ABO, / , 5x ,34  H  DISTRIBUTION  MATRIX  " C " • M  AT  HI X  .,//,SX,49U 
2  =  »  0BSEH7ATIC  NS  NC  X  *  CONTROLS  NC  ) 


/  FEEDPCR 
JUDIMENSIOII 

FORMAT-  (//,5XiSCHTHE  PS  E  DFO  RS  Af  D  ’  DIS  TBI  gllTION  MATRIX  "D"- MATRIX  . 

1  •  .//) 

PORMAT  (//5X.54HCO  YCU  WISH  TO  CHANGE  THE  7ALUE  OF  ANY  MATBIX  ELEM 
1EMT?,//, 10X, 1 9HTYEE  "YES"  OR  "KC".l 

1AT  ( IX, 3 1 HWABNING:  IMPROPER  DATA  ENTRY!  ENTER  "YES"  OR  "NO".) 
“  ( 51,5  OHENTES  THE  BCW  N02B23  OP  TBE  ELEMENT  TO  oc  CHANGED.) 


POBMA 
PORMAT 
POBMAT 
1.) 

END 


SX,5  3 B ENT EB  THE  CCLUMN  N0M3EB  OF  THE  ELEMENT  TO  BE  CHANGED 
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C S3  3  333  33  3  33  « 3  3 333 3  3 3 3  S 3 3 3 333 3  333  3  33333  33  S 333333333333  333  333  333  3  3  33  33  3  3= 

SUBROUTINE  RE  A  EG  (NS  ,  3C  ,  ISAG  ,  G) 

C  INTERACTIVELY  ENTESS  THE  **G  "  fiATRIX  CONTROL  D  IS  TRI30T  10  N  .1  A?!?  IX  » 

C =* 3  3  33  3=333  3333=3  3  3  333  S3 3  =3=  3  3  33  3  3  333 Z 33 3  33333333  3=  33  333  3=3  =  =  =  =  =  =33  =  33 

REAL'S  G(NS,MC)  ,£US,ANSS 
INTEGER  IANS, I  .u.K.l.ISAG 
CAT  A  IY/'Y'/.  I2/f:%V 
IF  (ISAG.EQ.l)  GO  10  40 
W  BITS  (5 , 1*  J) 

DC  20  1=1, NS 
DC  10  0=1. NC 
SHITS  (5,110)  I,J 
CALI.  BOREAL  (ANSI) 

G(I.J)=ANSH 
CON TIN US 
CONTINUE 


10 
20 
C  — 
30 
40 


50 

60 

70 


80 

90 

100 


C - 

1 1  0 
120 

130 

140 

150 

160 

170 


CALL  FHTCSS  { • CLH2CH N  •) 

CONTINUE 
S  BITE  (5,130) 

CALL  N  ATE  ST  (G,SS,NC) 

SHITE  (5,140) 

CALL  3DCHA8  (IANS) 

IF  ((IANS. NS. II)  .AND. (IANS. NE. IE))  GO  IC  60 
GO  TO  70 
WHITE  (5,150) 

GO  TO  50 
CONTINUE 

IF  (IANS. EQ. 12)  GC  TC  100 
WHITE  (S  ,  IbO) 

CALL  8 DIHI  (IANS) 

K= IANS 

iHITS  (5.170) 

CALL  H  DI ST  (IANS) 

L=IANS 

SHIT2  (5.110)  X ,  L 
CALL  HDREAL  ( A  NS  3 ) 

DU  M=  AN  SR 
00  90  1=1, NS 
DC  30  J*1,NC 

IF  ((I.SQ.K)  -  AND.  (J.EQ.  1)  )  G  (I,J)=D(/f1 

CONTINUE 

CONTINUE 

GC  TO  30 

CONTINUE 

CALL  F  ET  CSS  ('CLHSCHN  •) 

HETUaN 


FORMAT 

FORMAT 

1p6^iT° 

^cIshat 

’HiSif' 

FORHAT 
FOBS  AT 


1  eIae 


( 51, 1 4  HTH  E  ELEHENT  G  ( ,  12  ,  1 H ,  ,  12 , 2H)  =) 

</,5x, 5  1HENTES  THE  CONTROL  DISTRIBUTION  MATRIX  “G,,-8ATBIX 
i,43anIEENSICN  =  t  STATES  NS  X  <  CONTROLS  NC  ) 

(// »  1  0  X  ,4  7HTH  E  C0NT30L  CISTBI  EOT  ICN  flATRIX  "G"-!1ATRIX  ..., 

(//5X.54HDC  ICO  WISH  TC  CHANGE  THE  VALUE  OF  AHT  SAT3IX  SLEM 
,1CX,  19HTIIE  "YES"  OR  "XC".) 

( IX, 5 1 HH AKNIN G:  IfiFROPER  DATA  ENTRY!  ENTE3  "YES"  OR  "NO".) 
5X.50HENTEH  THE  BCS  N04BE8  OF  THE  ELEMENT  TO  3E  CHANGED. ) 
5X.53HENTES  THE  CCLUS11  NUMBER  OF  THE  ELEHENT  TO  BE  CHANGED 
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:s3ssss3isss3«  an*»  ** 


S=£=  3  3C  3233 


E  3333  33232SS* 


10 
20 
C  — 
30 


40 

50 

60 


70 

SO 

90 


C - 

100 

110 

120 

130 

140 

150 

160 


SSS3SS3S  ns3:i3S83:ssn3: 

SUBROUTINE  3  E  A  OF  3  f  NC,.‘IS  ,F3GC ) 

ENTERS  IRE  »C“  NAT5IX  FEEDBACK  GAIN  CONTROL  .1ATRIX 

1333333  313333333X333333333333 

BEAL*H  F  EGC  (  S  C  ,  N  S)  ,  CUN  ,  A  NS  R 
INTEGER  XANS,r,J,F,t 
LATA  lY/'Y' /, 12/' N'/ 

WRITE  (5,110) 

DC  20  1=1, NC 
DC  10  J=1,NS 
WRITE  (5,100)  I.J 
CALL  RDREAL  (  A  NSR) 

FBGC  (I  ,J)  »AN  S  R 
CCNTIN  u  £ 

CONTINUE 

CALL  FSTCSS  ('CLPSCEN  •) 

WRITE  (5,120) 

CALL  iATSBT  (PEGC.NC.NS) 

WHITE  (5,130) 

CALL  RDCBAR  (IANS) 

IF  ((IANS. NE. II)  .AND.  (IANS.  NE. 12)  )  GC  ?C  50 
GC  TO  60 
WRITS  (5,140) 

GC  TO  40 
CONTIN  UE 

IF  (IANS. £0.12)  GC  TC  90 
WRITE  (5,150) 

CALL  RDINT  (IANS) 

S=IANS 

WHITS  (5,160) 

CALL  HDINX  (IANS) 

L=IANS 

WRITE  (5 , 1  JO)  K  ,  L 
CALL  RDREAL  ( A  NS  3) 

DU.TANSH 
DO  30  1=1, NC 
DO  70  J=1,IIS 
IF  lit.  EC.K) 

CONTINUE 
CCHTINUE 
GO  TO  30 
CONTINUE 

CALL  FRTCBS  ('ClaSCHN  •) 

HETURN 


ARE.  (J.EQ.L)  )  FBGC(I.J)  =OUR 


(51,  1  U  HTEE  FLFBBNT  C  ( ,  1 2 . 1H, ,  12,  2H)  =) 

(/,3X,52HENTcR  THE  FEEEEACK  GAIN  CONTROL  3ATSIX  "C"-RATRXI 
0X,44HDIBENSICN  =  «  CONTROLS  NC  X  *  STATES  NS  .) 

(// ,  1  0 1  ,45HTH  c  FEEDBACK  GAIN  CCNTROL  NATRIX  "C’'-SAT2I  X  ,// 


OBBAT  (//5X.S4HDC  YCU  WISH  TC  CHANGE  THE  VALUE  OF  ANY  BATH II  EL2B 


FCBBAT 

FOBBAT 

1  foSsa*1 


130 


C*s ****** 33 3  3  **3S.=  3*3«  =  a**«3***  sa»3  **3*x*  x*  3*3333**3**3  *  =  *  *s*  *** 

SUBROUTINE  RSACA*  fNC,A!f) 

C  ENTERS  THE  "A"  HATBIX  DIAGONAL  OUT  TUT  COST  3 AT  R 12  . 

Q 3* *3  3 KX*X**X *333333  3  333  *33  333  3  3*3  33 3 3**3* * 

8E  AL*8  AY (NO  ,  NO)  ,DUN,ANSB 
INTEGER  IANS,!  ,J, f.L 
DATA  IY/*Y'/, IZ/'N'/ 

MBITS  (5,110) 

DC  20  1=1, NO 
DC  10  J=1,N0 


10 

20 

C— 

3C 


133*3333 


S3  333333a 


BRITS  (5,100)  I,J 
CALL  BDREAL  (ANS3) 
AY  (I, J)  aASSB 
CONTINUE 
CONTINUE 


40 

SO 

60 


CALL  PRIC8S  ( ‘CLfiSCSN  • ) 
MBITS  (5,120) 

CALL  HATeST  (A1,NC,»C) 
MBITS  (5,  ISO) 


CALL  3DCH&R  (IANS) 

IF  (TANS.NE.il)  .AND.  (IANS.  NE.  12)  )  GC  TC  50 


GC  TO  60 
HBITE  (5,140) 

GC  TO  40 
CONTIN  OE 

IF  (IANS . EO. IS)  GC  TO  90 
MR  ITS  <5,l50) 

CALL  3DI5T  (IANS) 

K»IANS 

HBITE  (5,16  0) 

CALL  3  DI NT  (IANS) 

L* IANS 

HHITE  (5,100)  K,I 
CALL  3DBEAL  ( A  NSR) 
DOSaANSR 
DC  ao  1*1,510 


70 

80 

90 

IF  iJ1- 
CONffNU 
CCNTINU 
GO  TO  3 
CONTINU 
CALL  PR 
EETUBN 

100 

PC BOAT 

110 

FORMAT 

120 

1HIX  .,/ 

POaNAT 

130 

1f£^hat 

140 

1  ENT? , // 
FORMAT 

150 

FOSHAT 

160 

FOBHAT 

1.1 

END 

COST  MATRIX  "A"-N AT 
X  *  OBSERVATIONS  NO 


(5X,14HTEE  ELSH2ST  A  (  ,  12 , 1H,  ,  12,  2H)  ») 

(//,3X.54RESTER  THE  OUTFOT  .IE  ASO  SEN  ENT 
, 5X,53 KDIHENSION  =  *  OBSERVATIONS  SO 

(//,5  X  ,50HTHE  OUTPUT  HEASUBSaENT  COST  .1  AT  BIX  "  A*-N AT3IX  .. 

(//5X.54EDC  TCU  MISH  TO  CHANGE  TBS  VALUE  OF  ANY  HATBIX  EL EH 
,1CX, 19HTYFE  "YES"  OB  "NO”.) 
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uu 


is  sr*  aa*s»*  *  ssisix  a 


3SS  331 3 


SUB  SOU  Tt  HE  BE  ACS  (SC. 3) 

ESTERS  THE  "5"  NATRIX  CONTRCI  COST  WEIGHTING  .1ATRIX  . 


10 
C  — 
20 


■  33X3SS3I3IK31 

REAL'S  E  (SC, SC)  .CUS.ASSR 
INTEGER  IANS, I  ,  J  ,  *  ,  L 
EATA  /,1Z/1  S1/ 

WRITE  (5,90) 

DC  10  £*1,;;C 
DC  10  Jal.SC 
WRIIE  (5.80)  I.J 
CALL  BOREAL  (AK53) 

S  (I.J)  =ANSB 


i  issaanaa  ssstuxsi 


E3SS1331 


30 


WO 

50 


60 

70 


C~ 

80 

90 


CALL  ERICHS  (•C18SCBK  •) 

WRITE  (5,100) 

CALL  SAIFBT  (E.SC.NC) 

9  GIT  2  (5,110) 

CALL  3ECHA2  (IASS) 

I?  JJIASS.SE. II)  .AND.  (IASS.  NS.  IZ) )  GC  TC  40 
GC  TO  50 
BBITE  (5,120) 

GC  TO  JO 
CONTINUE 

If  (IASS. EQ. 12)  GC  TC  70 
9  SITE  (5,130) 

CALL  BDINT  (IANS) 

K'lASS 

WRITE  (5,14  0) 

CALL  ROIST  (IANS) 

L'lANS 

WRITE  (5,60)  K,t 
CALL  HflH'AL  ( A  NSR) 

DU!I«ANSa 


DC  60  1=1, SC 

do  60  j*i ,:;c 

IF  JJI.  EC.K)  .  ANE.  (J.  EO.  L)  )  B(I,J)=OOS 
CONTIS  OE 
GO  TO  20 
CONTIS UE 

CALL  PRTCHS  ('CLSSCBN  •) 

RETORN 


100 

110 


120 

130 

140 


FCRHAT 

POBHAT 

’poii^T0 
POBHAT 
1  ENT?, // 
PCBHAr 
PORMAT 
POBHAT 


(5X,1UHTHE  EIEHEST  3J.I2.1R,, 12, 2H)=) 

!/,5X, 52EEN1E3  THE  CONTROL  "COST  WEIGHTING  HATRIX  "3"-8ATRI 
X.45HDiaESSICK  =  *  CONTfCLS  - 


NC  X  * 


...  _  .._  _  CONTROLS  NC  ) 

(//.10X.37HTHE  CONTROL  CCST  HATBIX . B. ..,//) 

1//5X , 5  4HDC  TOO  WISH  TC  CHANGE  THE  VALUE  OP  ANT  SATBIX  ELEN 
,  10X, 19HTYEE  "YES”  OH  "SC".) 

(1X.51HWARSISG:  IHFROPER  DATA  ENTRT !  ENTER  "YES"  OR  "SO".) 
5X.5  0HENTER  IRE  3 C9  HUPBER  OP  TBE  ELEHENT  TO  BE  CHANGED.) 
5X.52HENTER  THE  COLUHN  HU S3 E R  OP  THE  ELEHENT  TO  3E  CHANGED 


3RD 
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i 


V 


Casa  zssaaaiu  sssazataaasasiaxss  at  a 

sataouiiHE  a eaeo  ing.o) 

C  INTERACTIVELY  ESTHRS  TH3  " 

CMX  ****** auaa*  azaaMaaaasaaaansaa 

BEAL*8  C(NG,NG)  ,CUM,ANS3 
INTEGER  lASS.I  .J.h.L 
DATA  IY/*Y'/,  12/ *  SV 
WHITS  15.110) 

EC  4.\j  1 , N G 

DC  10  J=1,NG 
WRITS  (5,100)  I,J 
CALL  a DS £ 4L  (ANSR) 

CONTINUE 


,3  3  IS1SU3  3X3S3333S5333333S35353  3  5  333  3  33 

2"  MATRIX  NOISE  WEIGHTING  MATRIX 

E  33  33X3353  33335333X3X3335333333333535333 


10 
20 
c— 
3  0 


c— - 
100 
110 


m 

1«0 

150 

160 


call  ?aic»s  ccxascss  >) 

WHITE  (5,120) 

CALL  B ATF5T  (C.NG.NG) 

40  WHITS  (5,130) 

CALL  HDCHA3  (I1HS) 

IF  (  (I  ASS. ME.  IX)  .  AND.  (I  ANS.  ME.  IZ)  )  GC  TC  50 
S C  TO  60 

50  WHITE  (5,140) 

GC  TO  40 

60  COUTINOE 

IF  (IANS.  HO.  12)  GC  TO  90 
WRITE  (5,150) 

CALL  3  DINT  (IANS) 

K  » I A  MS 

WHITE  (5,160) 

CALL  3DINI  (IABS) 

L*IANS 

WRITE  (5.100)  r.l 
CALL  HDREIL  (  A  NS  R) 

dom^ansh 

DO  60  I*  1  ,NG 
DO  70  J» 1 ,SG 

IF  (JI.EC.K)  .AND.  (J.iQ.L)  )  Q(I,J)=D<JM 
70  CONTINUE 

ao  CONTINUE 

GO  TO  30 
90  CONTINUE 

CALL  FPTC3S  (’CLESCEN  ') 

RETURN 


FORMAT 
FORMAT 
1 , 12H  "0 

FOSSA! 

’RBif' 

rOHSAT 

FOaHAT 

1  it  d 


51,1 

X.27H 

\'M\ 

5X,5 

51.5 


4HTEE  ELEMENT  Q ( , 1 2 , 1 H, , 12 , 2H) =) 

X  ,  44  H  E  NT  EH  THE  PSCCESS  NOISE  PSD  WEIGHTING  MATRIX, / ,  5X 
IX  . ,//,5X,»2HOIME)SION  «  *  PROCESS  NOISE  SOURCES  NG 
•PROCESS  NOISE  SOURCES  NG  ) 

X.42HTHE  PROCESS  tCISE  WEIGHTING  MATRIX . 0-  . ,//) 

,54HCC  TCU  wish  TO  CHANGE  THE  VALUE  OF  ANY  MATRIX  ELEtl 
19HTYIE  "YES"  OR  "SO".) 

1HBASNING:  IMPROPER  DATA  ENTRY!  ENTER  "YES"  Oa  "NO".) 
OBINTIR  THE  RCW  NUE3E3  OF  THE  ELEMENT  TO  8E  CHANGED.) 
3HENTER  THE  COLUMN  NUM32R  OF  THE  ELEMENT  TO  BE  CHANGED 
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Q  33  =  .33 **-3  S33  6SSSS1  SS3 


c 

C  3333 


SDBROOTINE  REACH  (NO.RC) 

ENTERS  THE  "H"  MATRIX  N  EAS  0  HEM  ENT  NOISE  DISTRIBUTION  MATRIX 


S  3  S  S 


10 

c - 

2C 


30 


BEAL*8  BCISO.SO) ,EUM,ANSa 
INTEGER  IASS.I.J.K.L 
DATA  lY/'Y'/.lJ/'SV 
WHITE  (5*30) 
dc  io  i=i,so 

DO  10  J  =  1  .NO 
WHITE  (5.  SO)  I,J 
CALL  BDBEAL  (  A  NS  H) 

RC  (I,J)  =ANS3 


40 

50 


60 

70 


C  — 
80 
90 


100 

110 

120 

130 

140 


CALL  FBTCSS  ('CIRSCSN  ') 
asiffi  (5,100) 

CALL  N  A TP 51  (8C,tiC,SC) 

WHITE  (5,110) 

CALL  SDCHAB  (IANS) 

I?  ((TANS.  NS.  IX)  .AND.  (IANS.  NE.IZ)  )  GC  TC  40 
GC  TO  50 
WHITE  (5,120) 

GC  TO  30 
CONTIN  03 

IF  (IANS.EO.IZ)  GC  TC  70 
SHITE  (5,130) 

CALL  3DIST  (IANS) 

K=IANS 

WHITE  (5,140) 

CALL  RDIN1  (IASS) 

L=IANS 

WHITE  (5.60)  K.L 
CALL  RflBiJL  (ASSH) 

D0H=ANSH 
DC  60  1=1, NO 
DO  60  J *  7 , NO 

IF  I (I.  EClX)  .  AND.  (0.  SQ.L))  RC|I,J)=DUi« 

GO  TO  20 
CCNTINOE 

CALL  FRTCHS  (•CIESCBN  ') 

BETOHN 


DISTRIBUTION  "ATS  IX  " 
IONS  NO  X  5  OBSESVATIO 

2NS  NO  ) 

format  (//,i 5 x , scathe  seasijresent  noise  distsidotion  matrix . r. 

FoSmjPt  (//5X.54HDC  ICO  WISH  TC  CHANGE  THE  VALUE  OF  ANY  MATRIX  EL EH 
1EBT?,//,  1CX. 19HTYFE  "YES"  OR  "NO".) 


D 


Caitsisu 


>1  asxtianaMasssxsxsassxsstssn 


c 

c= 


SCE20UTIN£  S2A£FS  (NS, NO,? 3(32) 

INTERACT I7ELT  ESTERS  THE  "K  "  FEEDBACK 


10 

20 

c — 
30 

40 


50 

60 


EAL'8  F  EG2  (  NS  ,  SC)  , 
SUE-3  SB  IANJ.I.J.X. 1 
AT A  IY/*Y«/,IZ/‘ N*/ 


M*  »• 

REAL*8 
INTSG 
DATA  _  . 

SHITS  (5.110) 

DC  20  1=1, MS 
DC  10  J*1.NO 
WHITE  (5. ICO)  I.J 
CALL  HOREiL  (ANSS) 
FBGE(l.J)  *ANSH 
CCNTInSe 
CONTINUE 


COS, A  NS  3 


GAIN  ESTIMATOR  MATRIX 

XXZXS  S3 S3 SSK  S8S333 S  3SS3SI 


70 

80 

90 


C - 

100 

110 

120 

130 

140 

150 

160 


CALL  PRICES  ( 'CLHSCEN  •) 

SHITS  (5,120) 

CALL  SATPBT  (FEGE, NS, NO) 

WHITS  (5,130) 

CALL  HDCEAR  (IANS) 

IF  ((IANS.NS.il)  .AND.  (IANS.  NE.IZ)  )  3C  TO  50 
GO  TO  60 
WHITS  (5,14  0) 

GC  TO  40 
CONTIS  UE 

IF  (IANS. EQ.  12)  GC  TO  90 
WaiTS  (5,150) 

CALL  HEIST  (IASS) 

K  =  £  A  N  S 

W  SIT  E  (5,160) 

CALL  3DINT  (IASS) 

L= I ASS 

WHITE  (5,100)  A ,  L 
CALL  8CSEAL  (ASSS) 

Dua=»Nsa 
DO  80  1*1, NS 
DO  70  J*1,NO 
IF  ((I.EC.K) 

CONTIS  OS 
CONTINUE 
GO  TO  30 
CONTINUE 

CALL  FHTCBS  ('CLHSCB 
SETUHN 


ANE.  (J..  EQ.L)  )  FBGE  (I.J)  *D0M 


PCBHAT  (51, 
FORMAT  (/.5 
1IX  ..//,  1CX 
FORMAT  {//, 
1//) 

FORMAT  (//. 
1NENT? , // ,10 
FCfiaAT  (  IX, 
FORN1T  I"' 


14  HTEE  ELEMENT  K  (  ,  1 2  , 1 H,  ,  12,  2H)  =) 

X ,  54H2NTER  TS  E  FESEEACK  GAIN  ESTIMATOR  M  ATS  IX  "K"-MATE 
. 48BDI8SNSION  =  *  STATES  NS  X  ♦  0  8S  EHS  ATIONS  NO  .) 

1 5  X  ,47HTH  E  FEED3ACR  GAIN  ESTIMATOR  NATHIX  "(("-MATRIX  , 

5X.SUHC0  TOD  i ISH  10  CHANGE  THE  7AL0E  OF  ANT  MATRIX  EIS 
X , 1 9HT1EE  "YES"  CR  "NO".) 

'lHWAHNING  -  - 


FORMA 1 

Hnc 


_ _  IMPROPER  DATA  SNTRT !  ENTER  "TSS"  OR  "NO".) 

OHENTEH  THE  BCW  NUMBER  OF  TEE  ELEMENT  TO  BS  CHANGED.) 

--  ed 


51, _  ____  _  _  _  _ 

5X.52HENTES  THE  CCLD8N  NUM3ES  CE  THE  ELEMENT  TO  BE  CHANG 
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£  X333* 3*3*3  S  X  *  3S  ***  3  a  X  IS33t| 


t  3  3  3*  3  3  3  333333  3 


C 

C*« 


SUEHOUTISE  3  £  AC  Vi  (NG.WR) 

I  NT ESA CT IV ELY  ESTERS  »'WD"  STEADY  DISTURBANCE 

■■  mu  iiliisiiiii'ii  .ii  —  sm  aaaaaaaa  aaaaaaaaaa 

BIAL*8  WE(NG)  ,  CUM.  AN3R 
INTEGER  IAHS.I.K 
DATA  IT/' Y' /.  Il/1  NV 
WRITE  (5.100) 


VECTOR 

aaaaaa 


si  sss  a  a  a  a  a  a  s 


10 

c— 

2  C 


■  H  A  4  _  V-'#  'VWJ 

DC  U  1=1. MG 
WHITE  (5,30)  I 
CALI  3DRSAL  { A  NS  3 ) 
WE  (I)  =  ANSS 
CONTINUE 


30 

40 

50 


CALi  PRTCKS  ('CL3SCiN  •) 

W  SITE  (5,110) 

WHITE  (5,  SO)  ( WE  ( I)  ,  la  1  NG) 

WRITE  (5,120) 

CALL  3  CC  EAR  (IANS) 

IE  ((IANS. SB. IY)  .AND.  (IANS.  NE.IZ)  )  GC  TG  40 
GC  TO  50 
WHITS  (5,130) 

SC  TO  JO 
CONTINUE 

If  (IANS. EQ. 12)  GC  TO  70 
WHITE  (S.140) 

CALL  3DINT  (IANS) 

K=IANS 

WHITE  (5 , 80)  X 
CALL  RDREAL  (ASSP) 

DU  Na  AN  SR 
DO  60  I  =  1  ,NG 


60 

70 

IP  (I.  EC 
CCNTIM UE 
GC  TO  20 
CONTINUE 
CALL  PET 
RETURN 

80 

POR.NAT  ( 

90 

FOBS AT 

100 

FORMAT 

1ATHIX  ., 

no 

FORMAT  ( 

120 

FORMAT  ( 

1  ENT? , // , 

130 

FORMAT  ( 

140 

FOBS  AT 

END 

5X^1  5HTH  E  ELEMENT  W  J  <  ,12 , 2H)  =) 
/,5X,^7HSNTEH  THE  STEADY  DISTU 


1ATRIX  .,//,i6x,44H0IESNSICN  =  »  PROCESS  NOISE  SOURCES  NG 
^FORMAT  (^/,15X,53HTHE  STEADY  DISTURBANCE  VECTOR  MATRIX  " 


"W0"~M 
X  1) 

"-HATRI 


5X.54H0C  YCU  WISH  TC  CHANGE  THE  VALOS  OP  ANY  MATRIX  ELEM 
1UX,  19HTYEE  "YES"  OR  "NO".) 

IX, 51 HSARNING:  IHEHOPE6  DATA  ENTRY!  ENTER  "YES”  OR  "NO".) 
5X ,5  0  HEN  I  EE  I HE  RCW  NDK3ES  OF  I  HE  ELEMENT  TO  3E  CHANGED.) 
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c«* 

c 

c 

c 

c— 

C“ 

10 

20 

30 

40 

C-- 

50 

60 


ssisann  Mtiisit  xaaaa*  asa  s  as sasiasssxs  sisa  a  aaaams* 

SCBBOUTINE  8D8EA  1  —  I NTEB ACTIVEX*  HEADS  A  HEAD  NUP16EB  3E?L*  * 

INTO  A  ?0 HTEAH  P BOGS  AH.  XP  THE  USES  INADVEBTENL*  ENTEBS  A  NULL  « 
STRING  THE  S/B  ISSUES  A  BA  B  MING  AND  ALL  CBS  A  BECOVEBlf.  * 

888883888888888888188388883888388883888 8838838388383X3383133388833838 

SUBROUTINE  HDBEA1  (ANSB) 

B£AL*6  ANSB 
INT2GE3  COUNT 

COUNT»0 

CONTINUE 

CCUHT^COUNT* 1 

If  (COUNT.LT. 3)  GC  TO  20 

N  RITE  (5,60) 

GO  TO  40 
CONTINUE 

BEAD  (5,«,BND8830,EBB°30)  ANSB 

3ETU3N 

BEHIND  5 

HR  ITS  (5,50) 

GC  TO  TO 
CONTINUE 

STOP  __  __ 

POBHAT  (1X.64HHABNING:  NULL  STSINGS  ARE  NOT  ALLOHED,  ENTER  A  NONE 
1 BICAL  VALUE.) 

F0R3AT  (////, 2X,42HESOGBAM  KILLED  -  TkiO  NULL  STRINGS  ENTEBED!,/) 
END 


C3»*3SS#*S3J  233  XU  S  3SS«S33CS8SSXS3SUa«SSS  SCS  SIX3*33S<  X3£  X  SS  S33S  S3SXS3  U 

C  SCBROUTIM 2  3CINT  —  INTERACT tV EL  ?  BEADS  AN  INTEGER  REPLY 
C  INTO  1  FORTRAN  PRCGEAB.  IF  THE  CSER  INADVERTENLY  SISTERS  AN  IMPROPER* 
C  BATA  CHARACTER  THE  S/B  ISSUES  A  WARNING  AND  ALLOWS  A  RECOVERY.  a 

Ca» a  ********  **************  ***  *  ***  *********  **********  «*  ******  **********  ** 


c— 

10 

20 

30 

40 

SO 

C~ 

60 

70 


SUBROUTINE  3 DINT  (IANS) 
INTEGER  COUNT , IANS 


COUNT*  0 
CONTINUE 
COCNT*COCNT» 1 
IF  (CODNT.LT. 3)  GC 
WHITS  (5,60) 

'  50 


:c  20 


GO  TO  50 
CONTINUE 

a£A0  (5,*,2NC»«0.ERa=u0) 

I?  (IANS)  40,40,30 

CONTINUE 

RETUHN 

REWIND  S 

WRITE  (S  ,70) 

GC  TO  10 
CONTIN  UE 
STOP 


IANS 


PCRSAT 

1) 

POBHAT 

1GE3.) 

ESC 


(//, SI, 49 RE EC GRAB  TERHINATION 
( 1X,56HWARSISG:  IMPROPER  DATA 


-  ISO  IMPROPER  DATA  ENTRIES!! 
ENTRY!  ENTER  A  POSITIVE  ISTE 
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.  -*-*-•-*  s£®  U+O  -*D 

JlCWto^OOoOoOoOoO  I 
iOqOoOO  I 


C*»  >*«•*>»«  3sm»s 

C  SOB 30  UTIN  E  BATPRI 
C  III  7 ABIABLE  SCHESN 

CMM  •xmwmxmmm  tssnssia 

SUBROUTINE  HATE 
IBPLICIT  BEAL* 8 
DIMENSION  ?HTT 


snaiaaaaissua 

--  DISPLAYS  A  INC-DIB 
FCBHAT  FOR  USER  EASE 
animaxsaxaiasssi 
BT  (EBTT  .  NSQW  ,  NCCL) 
(A-B,0-f) 

(NEON  xNCOL) 


E  NS  ION  AL  ARRAY  <16  COLS.  BAX)  = 
IN  EON  IDENTIFICATION. 


ixasssxasaxn 


i? 

IP 

IF 

IF 

IF 

IF 

IF 

IF 

IF 

IF 

IF 

IF 

IF 

IF 

IF 

IF 


NCOL. 
NCOL . 
NCOL . 
NCOL. 
NCOL. 
NCOL. 
(NCOL. 
(NCOL. 
’NCOL. 
NCOL. 
NCOL. 
NCOL. 
NCOL. 
NCOL. 
NCOL. 
NCOL. 
NCOL. 


RETURN 


IQ-Q) 


NCCL*1 
N  BIT  E 
if  SI  1 1 
NBITS 
9  BIT  5 
NBITS 
NBITS 
NBITS 
NBITS 
NBITS 
NBITS 
NBITS 
WHITE 
NBITS 
WRITE 
WRITS 
WHITE 


sSioj 

5,50) 

5  I  60 
5  70 
(5.30) 

VA 

i:«8 

15,130) 
(5,  14  0) 
15,15  0 
<5,16  0 


jlPRTT 


PSTT 
<  iPRTT 
((PRTT 
)  (PRTT 
1 (PRTT 
'  PRTT 
PHTT 
PRTT 
PRTT 
i  (PSTT 
((PSTT 
(IPRTT 
((PRTT 
((PRTT 
((PSTT 


NCOL)  ,1= 
NCOL)  ,  1  = 
NCOL)  ,1* 
NCOL)  .1  = 
NCOL  ,1= 
NCOL)  ,1  = 
NCOL)  ,1- 
NCOL)  ,1= 
NCOL)  ,Ia 
NCOL  ,1= 
NCOL)  ,1  = 
NCOL)  ,1  = 
NCOL)  ,  1= 
NCOL  ,1* 
NCOL)  ,  I’ 
,  Ia 


NCOL 


1 ,  NR  ON) 
1,N20W> 
1,  N  20  W) 
1.NRON) 
1 ,  N  3  O  W ) 
1 ,  N  RON) 
1  ..IRON) 
1,NSON) 
1.NROW) 
1,  NRON) 
1,  N  RON) 
1 ,  NRON) 
1 ,  N  RON) 
1 ,  N  RON) 
1 .NRON) 
t.NROW) 
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FOBBAT 

F12. 

5) 

FORMAT 

2F 1 2 

.5 

PCRHAT 

*F  1 2 

.  5 

FORMAT 

«P12 

.5 

FORMAT 

b  f  1 2 

.  b 

FORMAT 

6P12 

.  b 

FOBBAT 

6F 1. 

.b 

PORBAT 

6F12 

.b 

FOBBAT 

6  F 1  ^ 

.5 

FORMAT 

6F1  2 

.  5 

FOBBAT 

b  F 1 2 

.  b 

FORMAT 

6F12 

#  b 

FOBMAT 

6F1* 

*  b 

FORMAT 

6F12 

:$ 

FCBHAT 

6F12 

PORBAT  ’ 

6F1 2 

.5 

EIC 


S 12 . 
3F 1 L 
./.5F12 


f  I  »  4  • 

13: 

,/,6F12 


5,//) 

5^/,NF12 


*!://{ 

5,//) 
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